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摘要 


无 人 驾驶 车 辆 是 一 种 移动 机 器 人 ， 其 关键 技术 涉及 到 环境 感知 、 模 式 识别 、 
导航 定位 、 智 能 决策 、 控 制 工程 以 及 计算 机 技术 等 众多 学 科 的 前 沿 研究 领域 , 是 
验证 机 器 感知 与 认 知 理论 和 关键 技术 的 最 佳 实验 平台 , 同时 其 技术 单元 也 可 以 帮 
助人 类 驾驶 员 进行 车 辆 自主 驾驶 工作 ， 并 以 此 提高 行车 的 安全 和 效率 。 

在 无 人 驾驶 车 辆 的 单元 技术 中 , 在 未 知 路 况 条 件 下 的 高 速 高 精度 轨迹 跟踪 自 
适应 控制 一 直 是 研究 的 重点 和 难点 , 针对 城市 综合 环境 下 无 人 驾驶 车 辆 的 运动 控 
制 问题 ,本文 在 传统 方法 的 基础 上 , 根据 车 辆 控制 模型 的 特殊 性 和 城市 环境 的 复 
杂 多 样 性 ,提出 了 一 些 新 的 解决 方案 ， 以 提高 算法 的 适应 性 。 具体 的 研究 内 容 包 
括 以 下 几 个 方面 

D 对 无 人 驾驶 车 辆 控制 理论 的 相关 概念， 对 国内 外 研究 成 果 进 行 分 析 ， 了 
解 汽车 的 运动 特性 及 建 模仿 真 方法 ， 了 解 不 同 环境 对 车 辆 运动 的 影响 ， 了 解 驾 驶 
员 的 驾驶 过 程 ， 从 人 对 车 辆 的 控制 方式 来 思考 无 人 驾驶 控制 所 要 面临 问题 

2) 对 城市 道路 的 分 类 和 各 自 特点 进行 了 归纳 总 结 ， 明 确 了 无 人 车 在 各 种 道 
路 环境 所 要 完成 的 任务 ; 以 “智能 先锋 "无 人 驾驶 车 辆 平台 为 基础 , 介绍 了 平台 的 
感知 系统 、 决 策 系统 、 控 制 系统 及 执行 机 构 。 结 合 无 人 驾驶 车 辆 在 城市 道路 运动 
控制 方面 过 到 的 关键 性 问题 提出 控制 系统 采用 的 研究 策略 和 设计 思想 。 

3) 分 析 车 辆 纵向 动力 学 ， 研 究 车 辆 纵向 控制 方法 。 分 析 总 结 "智能 先锋 " 动 
力 传动 特性 和 制 动 力学 特性 , 参考 实际 驾驶 员 对 车 辆 的 速度 控制 行为 , 结合 专家 
控制 方法 ， 提 出 专家 PID 控制 算法 ， 根 据 实际 驾驶 员 的 驾车 经 验 建立 专家 规则 ， 
解决 在 传动 系统 高 度 非 线性 和 复杂 的 纵向 干扰 条 件 下 的 控制 精度 的 问题 , 提高 速 
度 控制 的 鲁 棒 性 ， 实 现 无 人 驾驶 车 辆 在 城市 道路 行驶 的 速度 控制 。 

4) 研究 基于 车 辆 操作 动力 学 的 横向 控制 方法 。 建 立 车 辆 操纵 动力 学 模型 ， 
进行 车 辆 操纵 动力 学 和 轮胎 侧 向 力学 分 析 ; 在 “ 预 瞳 一 跟随 "理论 的 控制 模型 和 传 
统 PD 控制 方法 的 基础 上 设计 一 种 基于 小 脑 模型 神经 网 络 与 PD 复合 的 无 人 驾 
驶 车 辆 横向 控制 算法 , 使 系统 能 够 自动 补偿 被 控 模 型 和 输入 信号 发 生 的 非 预知 的 
变化 , 解决 由 于 模型 不 精确 或 存在 其 他 变化 因素 带 来 的 控制 不 确定 性 问题 , 从 而 
使 无 人 车 能 够 灵活 的 在 各 种 道路 环境 实现 稳定 准确 的 道路 跟踪 行驶 。 

5 研究 车 辆 高 速 行驶 时 的 运动 学 特性 ， 联 合 考虑 纵向 控制 和 横向 控制 之 间 
相互 制约 关系 , 根据 车 辆 操纵 稳定 性 及 每 适 性 的 要 求 建立 了 最 高 速度 和 最 大 转向 
角 的 约束 规则 ， 以 保障 车 辆 行驶 安全 性 。 

本 文 最 后 在 真实 的 城市 道路 环境 中 ， 以 “智能 先锋 "无 人 驾驶 车 辆 为 实验 平 
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G, 验证 了 上 述 研究 内 容 的 可 行 性 和 有 效 性 ,并 根据 实验 结果 总 结 了 目前 控制 | 系 
统 设计 方法 的 优势 和 不 足 ， 也 对 进一步 的 研究 提出 了 展望 。 


关键 词 : 无 人 驾驶 车 辆 ”路 径 跟 踪 控制 速度 跟踪 控制 专家 PID 控制 小 脑 模型 
神经 网 
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ABSTRACT 


The autonomous vehicle is one kind of mobile robots, whose key technologies are 
related to frontier research fields of environmental perception, pattem recognition, 
navigation and positioning, intelligent decision-making, control engineering, 
computer technology, and many other disciplines. It is not only the best experimental 
platform to exam the cognitive theory and the critical technology, but also, at the same 
time, its unit technology can help humans drive cars automatically to improve the 
driving safety and efficiency. 

In the technology of autonomous vehicle, the high speed and high precision 
self-adaptative control of trajectory tracking in unknown traffic conditions is always 
the key difficulty. To deal with the problems of autonomous vehicle’s motion control 
in urban environment and to improve the known traditional method, this paper 
presents some new solutions dealing with the specific characteristics of vehicle 
control model and complex diversity of city environment, to enhance the adaptability 
of the algorithms. Our research includes the following several aspects, specifically: 

1) We first briefly introduce the concept of vehicle control theory and the 
state-of-the-art international and domestic achievements. This includes the 
understanding of vehicle’s kinetic characters with its modeling and simulation, the 
understanding of the environmental influence on the vehicle’s and the understanding - 
of the driving process upon considering the way that human drives. 

2) This paper also summarizes the classification of urban streets and their 
respective characteristic, in a way that the tasks that the autonomous vehicle faced in 
various conditions clear. With the so-called “Intelligent Pioneer” as a basis platform 
of the autonomous vehicle, we introduce the platform of sensing systems, 
decision-making systems, control systems, and implementing agencies. We propose a 
control system’s research strategy and design idea that combine the key problems of 
autonomous vehicle’s motion control in urban environment. 

3) We analyze the vehicle longitudinal dynamics and study the method of 
vehicle longitudinal control. The power transmission characteristics and brake 
mechanical properties of “Intelligent Pioneer” is analyzed and summarized, according 
to the behavior of driver’s speed control, combining the expert control method. We 
develop the expert PID control algorithm, that establishes expert rules according to 
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the driving experience, solves the problem of control accuracy when the transmission 
system is highly nonlinear and the longitudinal interference is too complex, so that the 
robustness of speed control system can be improved and the goal of speed control of 
autonomous vehicle’s driving in urban road can be established. 

“4) We study the method of lateral control for vehicle operation dynamics. The 
model of vehicle operation dynamics is established for the research of vehicle 
operation dynamics and tire lateral mechanics. Upon the formally established theory 
and traditional PID control, this paper presents a new autonomous vehicle's lateral 
control algorithm based on a composite of the CMAC and PID control. This enables 
the system to compensate automatically when the model and input signal occur 
changes unpredictability, such that the autonomous vehicle can drive steadily and 
accurately in any kind of urban environments, 

5) We study the kinematic characteristics when a car travels at a high speed. We 
consider the restricted relationship between vertical control and lateral control 
federatively and establish the constraint between the highest speed and biggest 
steering angle at the request of stability and comfort, to ensure the safety of the 
vehicles. 

At last, this paper takes “Intelligent Pioneer” as the experimental platform to 
check the feasibility and to examine the research above in the real urban environment. 
We also summarize the advantages and shortages of control system’s design 
procedures. Future research directions are also proposed. 


Key Words: Autonomous Vehicle, Path Tracking Control, Speed Tracking Control, 
expert PID control, Cerebellar Model Articulation Controller 
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第 一 章 绪论 


1.1 课题 背景 及 意义 


社会 不 断 发 展 ， 科 技 日 益 进步 ， 我 们 的 社会 已 经 充斥 着 各 种 “机 器 智能 "， 从 
我 们 家 中 帮助 清洁 的 吸尘器 机 器 人 , 到 飞机 在 变化 莫 测 的 天 气 中 安全 降落 的 计算 
机 控制 。 跨 越 上 个 世纪 ， 我 们 目睹 越 来 越 多 用 以 替换 “苦力 "的 设备 ， 如 洗衣 机 ， 
微波 炉 , 机动 交 通 工具 , 以 及 能 够 提高 生产 率 和 生活 便利 的 个 人 电脑 和 信息 技术 。 
伴随 着 这 些 技术 的 发 展 , 我 们 在 生活 工作 中 可 能 受到 的 危害 已 大 大 降低 , 从 本 质 
上 讲 ， 我 们 的 技术 进步 一 直 专注 于 减少 发 生意 外 及 创伤 ， 并 保护 我 们 的 财产 。 

然而 ， 驾 驶 汽车 作为 一 种 日 常 行为 ， 既 枯燥 繁琐 又 充满 危险 。 每 时 每 刻 我 们 
都 要 关注 车 辆 行驶 时 周转 环境 的 变化 情况 ,我 们 会 面临 道路 条 件 极 差 的 危险 , 我 
们 可 能 会 质疑 其 他 驾驶 员 的 技能 或 判断 ， 甚 至 我 们 得 关注 自己 的 疲劳 或 失误 W 
KE, 这 些 沉 问 的 驾驶 行为 和 一 些 熟 练 驾 驶 经 验 , 可 能 会 导致 驾驶 员 注意 力 上 的 
朴 忽 ， 从 而 发 生意 外 事故 。 轰 驶 员 的 失误 是 绝 大 多 数 事故 发 生 的 主要 原因 ， 而 这 
些 事故 中 大 约 一 半 的 情况 下 ， 是 由 于 驾驶 员 反 应 的 延迟 所 致 。 此 外 ， 随 着 汽车 使 
用 率 的 增加 ， 由 于 人 类 感知 和 控制 能 力 的 局 限 性 ， 当 成 千 上 万 的 车 辆 在 同一 时 间 
共享 同一 段 道路 时 ， 必 然 导致 交通 堵塞 。 交 通 堵塞 ， 影 响 我 们 的 生活 质量 ， 并 且 
污染 空气 损害 公众 健康 。 当 车 辆 在 道路 上 通行 时 , 我 们 更 加 关心 其 通行 的 安全 和 
速率 等 因素 。 

从 2000 年 开始 ， 随 着 人 工 智能 、 模 式 识别 、 计 算 机 视觉 、 电 子 等 学 科 的 发 
R, 车 辆 已 经 不 再 是 一 个 复杂 的 机 械 结构 。 它 结合 了 许多 电子 控制 系统 ,集成 了 
许多 先进 的 科学 研究 成 果 。 电子 发 动机 控制 系统 的 采用 有 效 地 提高 了 汽油 机 的 效 
率 ，ABS 系统 的 应 用 改善 了 车 辆 的 安全 性 和 稳定 性 ， 主 动 悬 架 的 应 用 减轻 了 人 
们 乘坐 车 辆 时 的 不 适 感 ， 并 且 使 车 辆 的 行驶 变 得 更 加 平稳 。 但 我 们 更 希望 的 是 汽 
车 能 够 具有 自动 规划 行驶 路 径 ， 自 动 识别 道路 、 自 动 操纵 驾驶 等 先进 功能 ， 使 加 
驶 员 能 够 从 枯燥 繁琐 的 驾驶 行为 中 解脱 出 来 ,使 得 驾驶 更 加 安全 , 无 人 驾驶 车 辆 
技术 得 到 了 人 们 的 重视 。 城 市 综合 环境 信息 量 大 ， 复 杂 多 变 ， 通 过 开展 城区 较 大 
范围 内 和 复杂 多 变 交 通 环境 下 的 无 人 车 自主 驾驶 关键 技术 的 研究 , 对 增强 无 人 驾 
驶 车 辆 对 交通 环境 的 感知 识别 能 力 , 提高 车 辆 对 周围 信息 的 决策 控制 能 力 具有 重 
要 促进 和 引导 作用 。 在 无 人 驾驶 车 辆 平台 上 进行 的 汽车 电子 、 车 辆 主动 安全 技术 
的 研究 对 提高 交通 运输 能 力 、 减 少 交通 事故 ,增强 车 辆 的 智能 性 都 具有 很 高 价值 。 

无 人 驾驶 车 辆 也 被 叫做 智能 车 辆 , 是 一 种 智能 移动 机 器 人 , 它 涉及 到 环境 感 
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知 、 模 式 识别 、 导 航 定位 、 智 能 决策 控制 以 及 计算 机 技术 等 众多 学 科 的 前 沿 研究 
GR, 其 研究 目标 是 取代 人 类 驾驶 员 进行 车 辆 自主 驾驶 工作 , 并 以 此 提高 行车 安 
全 和 效率 。 无 人 驾驶 车 辆 作为 展示 计算 机 科学 、 模 式 识别 和 人 工 智能 技术 水 平 、 
引领 车 辆 工业 未 来 发 展 的 重要 平台 ， 已 成 为 世界 发 达 国家 研究 的 热点 。 


12 无 人 驾驶 车 辆 发 展现 状 


121, 国外 无 人 驾驶 车 辆 的 研究 现状 及 分 析 


《1) 美国 

国外 开展 无 人 驾驶 车 辆 研究 的 时 间 始 于 1950 年 ， 其 技术 高 速 发 展 是 在 1980 
年 左右 ,在 无 人 车 关键 技术 的 研究 中 , 在 研究 技术 的 水 平和 研究 成 果 的 普及 应 用 
方面 美国 都 表现 为 较 高 的 水 平 。1950 年 后 美国 贝 瑞 特 电子 公司 研制 出 全 球 第 一 
台 自主 导航 车 ， 能 够 自动 在 设 定 的 轨道 中 行驶 。 在 上 世纪 八 十 年 代 ,美国 开展 了 
自主 地 面 车 辆 ( AVI 项 目 ， 主 要 由 美国 陆军 与 国防 高 级 研究 计划 局 (DARPA) 合 
Heo 该 项 目 开发 成 功 了 一 辆 带 有 八 个 轮子 的 无 人 轰 驶 机 器 人 ,该 机 器 人 在 自 租 的 
地 形 上 行驶 较为 困难 ， 且 较 难 达到 很 高 的 车 速 。 上 世纪 九 十 年 代 ， 卡 内 基 梅 隆 大 
学 研究 制 成 了 智能 车 辆 Navlab-V， 该 车 在 许多 地 形 上 完成 了 长 距离 、 高 速度 的 
自主 行驶 实验 , 行驶 路 程 达 上 万 公里 (Andrew et al.2008)。 上 世纪 九 十 年 代 末 美 国 
国防 部 门 开展 了 DEMO 系列 无 人 车 的 研制 ， 在 以 后 的 十 年 时 间 里 ， 共 研究 制造 
tH 10 {È DEMO 车 型 (Shoemaker,C.M.et al.,1998; Albus.J. 2002)。 

2003 年 开始 美国 DARPA 组 织 在 2003 年 至 2007 年 之 间 举 办 了 三 次 无 人 驾驶 
车 辆 竞赛 ， 目 的 是 验证 无 人 车 在 复杂 变化 的 环境 中 的 自动 行驶 能 力 ， 以 推动 无 人 
车 技术 的 迅速 发 展 。2004 年 初 在 美国 的 Mojave Desert 举办 了 首届 DARPA 山路 
地 区 挑战 赛 , 总 里 程 228 千 米 ， 卡 内 基 梅 陀 大 学 的 "沙漠 风暴 "无 人 车 以 自主 驾驶 
里 程 11.78 千 米 的 成 绩 获得 第 一 名 。2005 年 下 半年 ，DARPA 组 织 第 二 届 无 人 车 
大 赛 ， 总 里 程 为 212 千 米 ， 此 次 比赛 中 有 23 组 车 队 参 与 。 最 终 ，Stanford 大 学 
的 Stanley 无 人 车 获得 了 第 一 名 ， 总 共用 了 近 7 个 小 时 的 时 间 ， 平 均 速度 达到 
8m/s(Thrun, S.et dl,2006), 其 余 完成 比赛 的 4 支 车 队 用 时 更 长 。 第 三 届 DARPA 城 
市 挑战 赛 2007 年 在 美国 洛杉矶 周围 的 一 个 军事 基地 举行, 总 行程 96 千 米 , 最终 
6 辆 车 完成 了 总 赛程 ，Camegie Mellon 名 为 "BOSS" 的 无 人 车 取得 第 一 名 ， 最 高 
行驶 车 速 为 48km/h。 该 无 人 车 以 雪佛兰 公司 Tahoe 为 平台 ， 配 备 了 GPS/INS È 
位 仪 、 车 辆 里 程 表 、11 个 激光 测 距 仪 、5 Millimeter-wave 雷达 和 2 个 视觉 相 
机 (Chris Urmson et al., 2008). Stanford 大 学 与 大 众 公司 合作 研制 的 "JUNIOR" 无 


2 
sise goood 


第 一 章 绪论 





人 车 在 4 小 时 29 分 的 时 间 内 完成 比赛 ,并 取得 第 二 名 (Michael Montemerlo et al., 
2008)。 弗 吉 尼 亚 州 大 学 的 无 人 车 “ODIN" 以 4 小 时 36 的 时 间 完 成 比赛 ， 并 取得 
第 三 名 (Andrew Bacha etal,2008)。 在 此 次 大 赛 中 ， 感 知 能 力 相 对 较 强 的 无 人 驾 
驶 车 辆 在 比赛 中 体现 出 较 强 的 优势 。 

2010 年 , Google 公司 研制 的 无 人 驾驶 车 辆 开始 了 实际 城市 道路 的 行驶 测试 ， 
总 共有 7 辆 车 参加 了 这 一 系列 的 测试 (Markoff J. 2010)。Google 公司 的 无 人 车 具 
有 完备 的 感知 能 力 和 高 水 平 的 人 工 智能 ， 可 以 指引 车 辆 的 正确 行驶 。 传感器 包括 
相机 ， 三 维 激光 雷达 ， 毫 米 波 雷达 ， 利 用 这 些 设备 ， 车 辆 可 以 自动 地 识别 出 信号 
灯 、 行 人 或 者 车 辆 等 其 他 障碍 物 。 同 时 ，Google 公司 的 无 人 车 可 以 运用 谷歌 地 
图 对 车 辆 进行 导向 ， 在 自主 行驶 条 件 下 ， 无 人 车 已 行驶 了 近 两 千 公里 。 

《2) 欧洲 

欧洲 各 国 在 无 人 驾驶 车 辆 方面 也 做 了 很 多 研究 工作 ， 走 在 世界 前 列 ， 
PROMETHEUS 计划 、PReVENT 计划 等 在 世界 范围 内 影响 很 大 。 

EUREKA 的 PROMETHEUS 计划 全 名 是 PROgraMme for a European Traffic 
of Highest Efficiency and Unprecedented Safety, Æ 1987 年 至 1995 年 欧洲 无 人 驾 
驶 车 辆 领域 最 大 的 研发 项 目 。Emst Dickmanns 是 20 世纪 80 年 代 无 人 驾驶 汽车 
的 先驱 , 1994 年 他 主持 研制 的 双胞胎 机 器 人 车 辆 VaMP 和 VITA-2 在 巴黎 的 多 车 
道 高 速 公 路 上 行驶 了 1000 多 公里 ， 在 车 流 繁忙 情况 下 最 高 车 速达 到 130 公里 / 
小 时 ， 并 能 自主 完成 跟踪 行驶 、 变 道 和 超车 (Shladoven,S.E. et al.,1991). 1995 年 
Dickmanns 重新 设计 了 S 级 奔驰 自主 驾驶 车 辆 , 完成 从 德国 慕尼黑 到 丹麦 哥 本 哈 
根 1600 公里 的 旅程 ， 最 高 时 速 超过 175 公里 /小 时 (Brusaglino,G.1992)。 
PROMETHEUS 取得 的 成 功 是 之 后 欧洲 开展 无 人 驾驶 车 辆 研究 的 基础 。 

PReVENT 是 欧盟 委员 会 资助 的 欧洲 汽车 行业 计划 ， 项 目 总 预算 超过 
€55,000,000， 从 2004 4 2 月 开始 到 2008 年 1 AF 4 年 时 间 ， 涉 及 50 多 个 合作 
单位 , 包括 了 世界 知名 的 汽车 生产 厂商 和 研究 机 构 。 项 目 细 在 通过 开发 示范 主动 
安全 技术 与 应 用 ,从 而 促进 道路 安全 , 通过 使 用 车 载 系 统 感知 事故 发 生 的 类 型 和 
性 质 ， 同 时 考虑 驾驶 员 状态 ， 来 避免 或 减轻 事故 。PReVENT 项 目 作为 主动 预防 
道路 安全 最 大 的 首创 之 一 , 提出 了 三 个 总 体 概念 ， 虚拟 安全 带 ， 时 间 一 碰撞 时 间 
表 ， 智 能 车 辆 的 三 层 架构 一 感知 ， 决 策 ， 执 行 。 

1998 年 6 月 意大利 帕 尔 玛 大 学 的 ARGO 智能 车 开展 了 路 程 近 两 千 公里 的 大 
范围 行驶 。 该 实验 车 的 核心 是 视觉 检测 车 道 线 技术 ， 采 用 的 是 GOLD(Generic 
Obstacle and Lane Detection) 系 统 ， 检 测 原 理 是 单 目 视觉 的 反 透视 变换 ， 使 用 立体 
视觉 系统 检测 道路 前 方 的 障碍 物 (Betrozzi,M.et al., 2000)。2010 年 10 H 28 H, 
帕尔马 大 学 Vislab 实验 室 研制 的 试验 车 使 用 绿色 能 源 作为 动力 ， 历 时 3 个 多 月 ， 
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行驶 13000 多 公里 ， 只 用 极 少 数 的 人 工 干预 ， 成 功 抵达 上 海 (Bertozzi Met 
al.,2010)- 

2006 年 5 月 ， 欧 洲 第 一 届 陆 地 机 器 人 试验 赛 ( 即 无 人 车 大 赛 ) (European 
Land-Robot Trial, ELROB) 在 德国 Hammelburg 的 军 方 训练 场 举行 。 该 赛事 类 似 
于 DAPAR 的 沙漠 挑战 赛 ， 比 赛 全 程 达到 200 多 公里 。 据 德国 军 方 介绍 ， 除 来 自 
德国 的 12 支队 伍 以 外 ， 还 有 其 他 5 个 国家 的 车 队 参 加 了 此 次 比赛 ,这 些 车 队 都 
是 非 美国 家 ， 比 赛 不 允许 密集 使 用 GPS。 

2007 年 9 月 ， 第 二 届 ELROB 在 瑞士 的 Ticino 举行 ， 来 自 5 个 国家 的 13 个 
队伍 参赛 ， 主 要 考察 机 器 人 在 安全 ， 消 防 ， 民 防 和 灾难 控制 领域 的 应 用 。 此 次 比 
赛 设置 了 4 项 比赛 方案 : 8 支队 伍 参与 了 非 市 区 环境 下 寻找 危险 品 区 域 , 10 支队 
伍 参与 了 城市 环境 下 在 拥挤 集 市 搜寻 简易 爆炸 装置 ，2 支队 伍 参 与 了 与 无 人 机 无 
人 车 联合 作战 ，7 支队 伍 参与 了 城市 自主 侦察 、 治 安 巡 远 。 

2008 年 6 月， 第 三 届 ELROB 由 德国 联邦 武装 部 队 主办 ， 来 自 德国 、 法 国 、 

兰 、 意 大 利 等 10 个 国家 的 20 多 支队 伍 参 赛 。 此 次 比赛 主要 考察 无 人 驾驶 系统 
的 短期 作战 能 力 ， 比 赛场 景 尽 可 能 接近 实战 环境 。 

2009 年 5 月 , 第 四 届 ELROB 比赛 在 波兰 举办 ， 仍 以 考察 机 器 人 在 安全 ， 消 
防 ， 民 防 和 灾难 控制 领域 的 应 用 为 主 。 此 次 比赛 也 设置 了 四 个 比赛 项 目 , 在 乡村 
环境 下 收集 环境 信息 , 检测 并 报告 目标 信息 ; 在 城市 环境 下 搜索 预先 指定 的 区 域 ， 
发 现 ， 报 告 并 监测 运动 物体 ; 沿 着 预先 指定 路 线 自主 导航 ; 在 两 个 已 知 地 点 间 往 
返 运输 。 

2010 年 5 月 , 第 五 届 ELROB 比赛 在 德国 Hammelburg 举办 ， 此 次 比赛 以 考 
察 军事 应 用 为 主 , 并 着 重 考察 车 辆 在 夜间 的 表现 。 比赛 项 目 包括 在 目标 位 置 做 侦 
察 和 监视 、 在 混合 地 形 条 件 下 的 车 辆 移动 、 在 混合 地 形 条 件 下 来 回 运送 等 。 

英国 于 20 世纪 初期 已 经 在 一 些 机 场 布置 智能 车 辆 为 旅客 服务 。 同 时 ， 英 国 
政府 发 出 声明 ， 在 以 后 的 几 十 年 内 ， 将 为 无 人 驾驶 车 辆 建造 专门 的 道路 ， 同 时 ， 
为 了 兼容 已 有 的 道路 , 将 在 已 建造 道路 中 划分 出 新 的 智能 车 辆 专用 道 。 相 关 研究 
人 员 表示 , 智能 车 辆 先进 的 主动 安全 等 技术 将 使 得 城市 交通 更 加 顺畅 ,大 大 减少 
了 事故 的 发 生 率 。 在 新 能 源 的 利用 上 ， 无 人 驾驶 车 辆 也 走 在 了 现 有 车 型 的 前 列 。 

“ 赛 卡 博 "(Cycab) 是 由 INRIA 公司 研究 成 功 的 ， 这 家 位 于 法 国 的 公司 总 共 花 
费 了 近 9 年 的 时 间 才 将 这 辆 外 形 看 起 来 像 高 尔 夫 球 车 的 无 人 驾驶 车 辆 推出 市 场 。 
在 演示 中 ， 乘 客 只 需要 在 “ 赛 卡 博 "的 人 机 交互 界面 上 输入 目的 地 的 地 址 ， 通 过 强 
大 的 卫星 定位 系统 与 智能 传感器 与 人 工 智能 技术 ， 该 车 可 以 安全 地 到 达 目的 地 。 
值得 一 提 的 是 ， 与 普通 的 民用 GPS 系统 不 同 的 是 ，Cycab 的 定位 精度 可 以 达到 
0.1 BK. 
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欧洲 各 国 进行 无 人 车 辆 研制 , 也 是 以 城市 道路 环境 等 结构 化 道路 情况 下 的 应 
用 居多 。 与 美国 DARPA 比赛 不 同 的 是 ， 欧 洲 ELROB 是 军用 民用 主题 间隔 ， 综 
合 考 虑 了 消防 、 搜 救 、 运 输 、 夜 视 环境 等 等 ， 而 且 比赛 不 允许 密集 使 用 GPS。 这 
与 我 国 2010 智能 车 未 来 挑战 赛 提出 的 不 允许 使 用 GPS 的 目标 一 致 。 

(3) 日 本 

日 本 的 交通 部 门 从 上 世纪 九 十 年 代 开始 实施 先进 安全 车 辆 ASV) 计划 。 

目前 ， 日 本 对 ASV 开发 已 经 走 过 了 三 个 阶段 ， 第 四 阶段 也 刚刚 结束 。 第 一 阶段 
是 1991 年 ~1995 年 ， 由 政府 编列 预算 并 由 各 大 汽车 企业 进行 乘 用 车 四 大 类 20 
项 先进 安全 系统 技术 的 研发 ， 此 阶段 主要 考察 在 车 辆 上 安装 高 科技 装置 的 可 能 
性 ,如 何 应 用 这 些 技术 及 他 们 能 减少 交通 事故 的 程度 ; 第 二 阶段 是 1996 年 ~2000 
年 ， 适 用 对 象 增加 了 商用 车 ， 系 统 技术 也 增加 了 6 大 类 32 项 ,开始 对 ASV 车 辆 
实用 化 进行 开发 研究 ， 开 发 出 35 AVS 车 辆 进行 展示 ， 对 安全 理念 进行 整理 ， 
确认 了 开发 的 方向 , 对 事故 降低 程度 进行 了 验证 ; 第 三 阶段 是 2001 年 ~2005 年 ， 
这 一 阶段 主要 对 ASV 车 辆 的 普及 化 进行 探讨 ， 并 开发 新 技术 ， 主 要 表现 在 提高 
ASV 车 辆 的 社会 可 接受 程度 ， 开 发 先进 的 自动 驾驶 车 辆 ， 并 将 先进 的 通信 技术 
应 用 到 ASV P, 第 四 阶段 是 从 2008 年 ~2010 年 ， 本 阶段 除 将 正式 普及 此 前 就 
投入 使 用 的 通过 摄像 头 和 雷达 等 的 主动 预防 事故 系统 之 外 , 还 将 力争 实现 上 一 阶 
段 实施 的 利用 车 间 无 线 通信 技术 来 防止 事故 的 “信息 交换 型 驾驶 辅助 系统 "的 部 
分 实用 化 ( 冢 田 幸 广 .2007; Kamiya,H.1996)。 

日 本 还 曾 成 功 研制 出 适合 城市 环境 的 无 人 驾驶 公共 汽车 ， 被 称 为 "新 一 代 城 
市 长 途 交 通 系统 "。 这 套 公共 交通 车 辆 自动 驾驶 系统 也 包含 在 日 本 现在 着 力 发 展 
的 智能 交通 系统 当中 ， 它 主要 由 车 道 跟踪 、 安 全 防 碰撞 驾驶 、 集 群 行 驶 及 其 管理 
等 几 方面 组 成 , 这 套 系统 的 主要 原理 是 运用 磁性 装置 进行 导航 。 在 车 前 , 配备 有 
毫米 波 雷达 ， 带 有 红外 功能 的 相机 ， 激 光 雷 达 等 装置 ， 利 用 这 些 传 感 设备 ， 可 以 
轻松 对 车 外 环境 进行 建 模 ， 这 样 ， 通 过 车 辆 的 中 枢 电 脑 ， 就 可 以 对 车 辆 的 速度 、 
行驶 状态 进行 控制 ， 当 障碍 物 进入 车 辆 的 安全 行驶 范围 内 , 车 辆 就 会 减速 或 者 制 | 
动 刹车 中 枢 管理 系统 通过 安装 在 车 门 的 摄像 机 和 雷达 等 传感器 , 在 靠 站 停车 时 ， 
对 乘客 的 上 下 车 情况 进行 检测 ， 控 制 车 门 的 开启 与 关闭 ， 车 辆 的 启动 与 停止 。 这 
套 公共 交通 系统 的 最 高 运行 速度 达到 25 米 / 秒 ， 在 道路 较 弯曲 时 ， 运 行 速度 可 达 
10 米 秒 。 

同时 ， 日 本 的 主要 汽车 制造 商 ， 如 Honda, Nissan, Toyota 等 ， 也 对 车 辆 的 
主动 安全 系统 大 为 关注 并 开展 了 具体 的 研究 ,其 中 包括 : 车 辆 感知 模型 系统 、 车 
辆 主动 自 定位 系统 、 车 辆 跟随 系统 、 驾 驶 员 面 部 检测 系统 和 夜间 行车 系统 等 , 日 
本 的 智能 公路 《Smart Way) 研究 计划 中 指出 ， 将 智能 车 辆 中 的 关键 技术 例如 跟 
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随 车 道 ， 安 全 行驶 通过 路 口 、 主 动 避 碰 和 保持 车 更 应 用 到 普通 车 辆 中 。 

提出 车 辆 上 采用 诸如 : 防止 车 辆 越 车 道 线 、 路 口 安全 通过 、 检 测 行人 和 车 辆 
跟随 等 技术 。 二 十 一 世纪 初 到 二 十 一 世纪 一 从 年 代 , 在 一 个 已 有 行驶 实验 计划 的 
基础 上 , 日 本 决定 在 全 国 范围 内 开展 智能 道路 计划 。 日 本 的 无 人 驾驶 车 辆 技术 主 
要 是 将 智能 车 的 关键 技术 运用 到 现 有 的 交通 系统 中 ,而 对 于 车 辆 的 自主 决策 、 智 
能 路 径 规划 则 关注 较 少 。 


122 我 国 无 人 驾驶 车 辆 的 研究 现状 及 分 析 


智能 移动 机 器 人 的 研究 在 我 国 兴起 于 二 十 世纪 八 十 年 代 , 相对 于 发 达 国家 来 
说 ， 时 间 较 晚 。 在 1980 年 ,“ 通 控 驾 驶 的 防 核 化 侦察 车 "由 国家 立项 ， 并 有 三 家 
单位 参与 了 研究 制造 , 三 家 单位 分 别 是 哈尔滨 工业 大 学 、 沈阳 自 动 化 研究 所 和 国 
防 科技 大 学 。 

在 第 八 个 五 年 计划 期 间 ， 我 国 研制 成 功 了 ATB-1(Autonomous Test Bed-1), 
它 由 北京 理工 大 学 、 浙 江 大 学 、 国 防 科技 大 学 、 清 华 大 学 、 南 京 理工 大 学 联合 研 
制 ,是 我 国 第 一 辆 自主 行驶 测试 样 车 , 该 车 速度 可 达 二 十 一 公里 每 小 时 ,在 ATB-1 
的 基础 上 ， 第 九 个 五 年 计划 期 间 ，ATB-2 顺利 研制 成 功 。 该 车 的 功能 大 大 加 强 ， 
在 试验 中 ,直线 速度 最 高 可 达 二 十 一 米 每 秒 , 平均 行驶 速度 为 十 米 每 秒 。 该 车 还 
附带 遥感 控制 等 功能 。 在 2005 年 ， 第 三 代 自主 行驶 车 辆 Autonomous Test Bed-3 
顺利 面世 ， 该 车 的 环境 认 知 、 障 碍 物 检测 及 轨迹 跟踪 的 能 力 大 大 加 强 。 

国防 科技 大 学 研制 的 无 人 驾驶 汽车 一 红旗 CA7460 也 是 国内 高 水 平 的 自主 
车 辆 驾驶 平台 ， 其 最 高 的 速度 可 达 47 米 每 秒 ， 并 且 可 以 依据 前 方 障碍 车 辆 的 情 
况 ， 自 动 更 换 车 道 ， 清 华 大 学 研究 制 成 的 无 人 驾驶 车 辆 一 THMR-V〈Tsinghua 
Mobile Robot)， 最 高 速度 达到 42 米 每 秒 ， 并 且 ， 车 辆 可 以 选择 驾驶 模式 ， 可 选 
模式 有 高 速 路 和 城区 公路 两 种 ， 首 辆 应 用 在 普通 城区 中 的 无 人 驾驶 车 Cyber C3, 
是 由 上 海 交 通 大 学 与 欧洲 科学 研究 机 构 共 同 合作 研制 的 ; 西安 交通 大 学 著名 的 无 
人 驾驶 车 辆 平台 一 Springrobot， 在 国内 也 具有 领先 水 平 ， 其 在 车 道 线 检测 、 行 人 
检测 技术 上 拥有 较 高 水 平等 等 。 

2008 年 ， 国 家 自然 科学 基金 委员 会 启动 了 “视听 觉 信息 的 认 知 计算 "研究 计 
划 项 目 , 该 项 目的 主要 内 容 是 以 无 人 车 为 验证 平台 ,进行 视听 觉 认 知 计算 理论 研 
究 ， 在 该 项 目的 支持 下 ，2009 年 至 2011 年 分 别 举行 了 三 届 无 人 驾驶 车 辆 大 赛 。 
该 比赛 大 力 推动 了 无 人 车 领域 关键 技术 的 研发 .先后 有 南京 理工 大 学 、 武 汉 大 学 、 
湖南 大 学 等 我 国 早期 开展 无 人 车 研发 的 科研 机 构 组 成 无 人 车 车 队 参 与 了 大 赛 。 
2010 年 ， 中 国 科学 院 合肥 物质 科学 研究 院 研制 的 无 人 驾驶 车 辆 一 一 “智能 先锋 ” 
取得 比赛 第 一 名 (Pan Zhao,ct al.,2011)， 并 在 2011 年 的 比赛 中 获得 第 三 名 的 好 成 
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绩 (Tao Mei,et al.,2012)， 为 本 实验 室 开展 面向 城市 综合 环境 的 无 人 驾驶 车 辆 关键 
技术 及 平台 研究 莫 定 了 良好 的 基础 。 

在 国家 自然 科学 基金 委员 会 的 支持 下 ， 国 内 无 人 车 技术 得 到 了 快速 的 发 展 ， 
但 是 要 求 车 辆 实现 真正 的 自主 行 驼 ， 还 需要 较 长 的 时 间 。 现 在 的 智能 车 辆 技术 ， 
不 仅 在 环境 建 模 方面 有 所 缺陷 , 无 人 车 的 控制 水 平 还 急需 提高 。 所 以 ， 开 展 对 无 
人 车 控制 系统 的 研究 十 分 必要 。 


13 ”无 人 驾驶 车 辆 控制 理论 的 相关 概念 及 研究 现状 


无 人 驾驶 车 辆 的 关键 技术 包括 对 车 辆 行驶 环境 的 感知 、 对 车 辆 行驶 路 径 的 规 
划 、 对 驾驶 行为 的 智能 决策 、 对 车 辆 的 导航 定位 以 及 对 车 辆 的 自动 控制 BA 
驶 车 辆 的 控制 系统 作为 智能 车 辆 最 底层 、 最 重要 的 环节 , 一 直 受 到 广大 专家 学 者 
的 重视 。 目 前 在 无 人 驾驶 车 辆 控制 技术 方面 还 存在 以 下 一 些 共 性 问题 : 在 工 况 大 
范围 变化 时 ， 车辆 运动 出 现 震 东 以 及 趋 于 不 稳定 的 情况 ; 精确 定点 停车 和 机 动 控 
制 能 力 尚 显 不 足 ; 控制 算法 自 适应 能 力 不 强 , 不 同 的 道路 环境 下 需要 采用 不 同 的 
控制 算法 。 为 了 实现 在 城市 环境 下 ， 车 道 保 持 、 车 速 控制 、 定 点 泊 车 等 任务 ， 还 
需要 提高 控制 系统 的 自 适应 性 、 重 棒 性 和 智能 性 。 

车 辆 控制 包括 控制 车 辆 技 照 期 望 的 速度 行驶 , 执行 上 层 系统 规划 出 的 期 望 路 
径 ， 跟 随 前 方 车 辆 等 。 无 人 驾驶 车 辆 是 一 个 非 线性 的 系统 ， 如 何 设计 控制 器 ， 以 
实现 高 精度 的 纵向 和 横向 控制 是 无 人 驾驶 车 辆 研究 所 必须 解决 的 重点 问题 .许多 
专家 、 科 研 人 员 都 对 无 人 车 控制 系统 的 研究 非常 重视 , 也 获得 了 一 定 的 研究 成 果 。 


1.3.1 无 人 驾驶 车 辆 运动 学 和 动力 学 分 析 及 建 模 方法 


本 文 所 研究 的 车 辆 动力 学 目的 主要 是 解决 车 辆 操纵 稳定 性 问题 ,操纵 稳定 性 
问题 的 研究 需要 我 们 建立 一 个 表达 车 辆 动力 学 运动 学 特性 的 并 且 简单 通用 的 数 
学 模型 。 车 辆 的 运动 学 模型 主要 表现 车 辆 的 行驶 轨迹 、 车 速 等 几何 特性 ， 而 动力 
学 模型 主要 表现 车 辆 在 受 外 界 力 与 力矩 作用 时 速度 和 方向 的 变化 等 物理 特性 。 

关于 车 辆 横向 动力 学 的 研究 开始 于 20 世纪 50 年 代 , 主要 通过 建立 车 辆 动力 
学 模型 的 并 对 其 进行 开 环 控制 的 方法 研究 车 辆 行驶 时 的 时 域 和 频 域 响应 ,在 对 车 
辆 的 稳 态 与 豚 态 特性 研究 中 ， 可 以 得 到 车 辆 行驶 时 的 各 种 特征 数据 。 例如 : 车 辆 
前 轮转 角 为 阶 跃 值 时 的 稳 术 与 退 态 响应 车 辆 的 横 摆 角速度 响应 ， 车 辆 转向 不 足 
或 者 转向 过 度 等 特性 。 但 是 ， 采 用 此 种 方法 需要 建立 准确 的 车 辆 动力 学 模型 。 

20 世纪 中 期 ，Whitecomb 和 Milliken(1956)- 来 自 美国 Comell 大 学 的 研究 人 
员 首 先 开展 了 车 辆 "线性 二 自由 度 " 转 向 模型 的 研究 ，Segel (1956) 提 出 “线性 三 自 
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由 度 "转向 模型 随后 Segal (1965) 又 发 表 了 关于 “线性 四 自由 度 "模型 的 著作 。1960 
年 到 1980 年 之 间 ， 由 于 计算 机 技术 的 迅猛 发 展 ， 更 多 复杂 的 车 辆 模型 ， 例 如 有 
7 自由 度 , 14 自由 度 ,17 自由 度 乃至 更 多 自由 度 的 模型 在 许多 学 者 的 手中 被 建 
立 起 来 。 在 1995 年 ， 一 种 18 个 车 辆 状态 的 模型 被 建立 起 来 ， 它 可 以 准确 的 描述 
出 车 辆 轮胎 ， 发 动机 ， 悬 架 ， 底 盘 等 特性 。 这 个 复杂 而 又 精确 的 模型 是 由 美国 加 
州 大 学 的 Hedrick J.K., Tomizuka M.(1994) 提 出 的 。 同 时 ， 美 国 公路 安全 研究 所 的 
Segal DJ 了 建立 了 15 自由 度 模型 ， 国 内 的 杨 得 军 (1997) 又 开发 了 17 个 自由 度 的 车 
辆 模型 ， 它 主要 应 用 于 模拟 驾驶 器 中 。 


13.2 ”驾驶 员 模 型 的 研究 


这 一 段 时 间 , 许多 研究 人 员 在 车 辆 操纵 稳定 性 的 研究 中 , 逐渐 倾向 于 对 驾驶 
员 模型 进行 研究 ， 从 高 自由 度 的 车 辆 模型 的 建立 转移 到 对 整个 道路 -车 辆 -驾驶 员 
系统 的 性 能 研究 中 , 并且 最 终 得 出 结论 , 车 辆 操纵 稳定 性 的 研究 取决 于 整个 道路 
-车 辆 -驾驶 员 系统 的 特性 。 基 于 这 个 结论 ， 许 多 专家 学 者 进行 了 驾驶 员 模型 和 车 
辆 闭环 系统 的 研究 。 在 初始 阶段 ，MuRuenD.T(1968) 首 开 先例 ， 将 飞机 上 的 闭环 
控制 技术 应 用 到 车 辆 中 。 而 后 ， 利 用 经 典 控制 理论 所 建立 起 来 的 PID 模型 、 交 
叉 分 类 模型 、 低 阶 预 测 模型 、 最 优 预 赠 控制 模型 及 预 晓 最 优 曲 率 模型 被 应 用 到 如 
驶 员 模型 的 建立 中 。Reddy,Ellis(1981) 在 以 上 成 果 上 ， 建 立 了 一 种 对 驾驶 员 行 为 
进行 模仿 的 模型 。 这 种 方法 的 基本 原理 是 : 假定 驾驶 员 固定 视线 在 车 辆 前 方 距离 
为 1 的 地 方 ， 以 当前 时 刻 + 的 车 辆 状态 为 标准 ， 估 算出 一 定 的 方向 盘 角度 ， 并 碍 
看 车 辆 在 行驶 到 1/ 后， 行驶 轨迹 与 预定 轨迹 的 相差 程度 。 如 果 误 差 过 大 的 话 ， 则 
重新 修改 方向 盘 转角 ,直到 满足 误差 要 求 为 止 ， 通 过 这 种 逐 时 刻 估算 来 模拟 驾驶 
员 驾 驶 车 辆 时 的 行为 与 上 述 方法 类 似 的 是 由 MacAdamia 提出 的 直接 优化 驾驶 
员 模 型 的 方法 。 我 国学 者 郭 孔 辉 院士 在 驾驶 员 模型 的 研究 中 ,也 做 出 了 巨大 的 贡 
献 ， 他 提出 并 建立 了 的 预测 一 跟随 系统 理论 和 预 障 最 优 曲 率 模型 ， 方 法 简单 ， 准 
确 性 高 。 


133 无 人 驾驶 车 辆 的 控制 方法 


无 人 驾驶 车 辆 的 控制 方法 是 该 领域 研究 的 关键 技术 之 一 。 由 于 车 辆 模型 随 着 
时 间 的 改变 , 其 系统 参数 会 发 生变 化 , 模型 参数 极其 复杂 ， 模 型 方程 非 线性 等 特 
A, 车辆 控制 方法 研究 集中 在 提高 控制 算法 的 抗 干扰 性 和 自 适应 性 能 。 车 辆 的 控 
制 任务 也 从 简单 的 纵向 控制 、 横 向 控制 ， 扩 展 到 超车 任务 、 泊 车 任务 。 

车 辆 控制 的 理论 研究 方向 主要 分 为 汽车 横向 跟踪 控制 和 纵向 跟踪 控制 两 个 


8 
sise 000000 


第 一 章 绪论 





方向 。 在 横向 控制 的 研究 中 出 现 了 许多 不 同 的 理论 和 方法 (Bars, Ret al.,2006), 
其 中 包括 支持 向 量 基 方法 (Gao Feng,et al,2006)、 分 阶 控制 方法 (Dejun Zhuang. 
2007)、 传 统 PID 控制 方法 (Li, Y,et al.,2006)、 智 能 控制 方法 包括 模糊 控制 (Hessburg, 
T. 1994; Choomuang R.,et al,2005) 和 神经 网 络 控制 方法 (Scott GM.,et al.,1995; Wai 
RJ. 2003) 等 。 刹 车 与 油门 的 配合 问题 和 控制 精度 的 抗 干扰 能 力 问题 是 纵向 控制 
所 应 关注 的 焦点 。 


134 ”无 人 驾驶 车 辆 控制 理论 的 国内 外 研究 现状 


在 2007 年 美国 的 DARPA 举办 的 无 人 车 城市 挑战 赛 中 ，11 支 车 队 进 入 了 最 
终 的 决赛 ,冠军 车 队 BOSS 的 控制 策略 分 为 道路 导航 和 区 域 导航 (Chris Urmson, et 
al, 2008)， 在 道路 导航 中 ， 为 了 提高 控制 鲁 棒 性 并 避免 静态 和 动态 的 障碍 物 ， 运 
动 规划 根据 道路 中 心 线 生成 一 系列 轨迹 和 局 部 目标 , 其 纵向 距离 是 固定 的 , 但 是 
横向 距离 不 同 。 使 用 轨迹 生成 算法 计算 到 达 目 标点 轨迹 的 可 行 性 。 对 于 每 一 个 目 
标 , 生成 两 个 轨迹 : 一 个 光滑 的 轨迹 和 一 个 陡峭 的 轨迹 。 光 滑 的 轨迹 初始 曲率 参 
数 固定 为 车 辆 状态 前 瞻 性 预测 的 曲率 , 陡峭 的 轨迹 初始 曲率 参数 设置 为 从 车 辆 前 
脆性 预测 到 产生 一 个 急剧 初始 行为 的 补偿 值 .轨迹 上 的 速度 分 布 需 要 根据 诸多 因 
素 进 行 计算 , 包括 行为 子 系统 给 定 的 最 大 速度 的 约束 、 当 前 路 段 的 车 速 限制 、 鉴 
于 道路 中 心 线 曲率 的 最 高 可 行 速度 和 目标 点 的 期 望 速度 。 其 特点 是 ， 考 虑 的 情况 
非常 充分 ， 从 而 使 得 系统 的 鲁 棒 性 很 强 。 

取得 第 三 名 的 车 队 Odin 采用 了 基于 驾驶 员 行为 的 控制 模型 (Andrew Bacha, 
et al.2008)， 将 驾驶 行为 分 为 :〈1) 按 预 定 路 线 行驶 CRNDF): 在 没有 交通 车 辆 
和 其 它 障 碍 物 的 情况 下 ，〈2) 通过 驾驶 ， 过 到 障碍 物 或 者 慢车 时 ， 选 择 合适 的 驾 
驶 行为 安全 顺利 的 通过 ;3) 封锁 驾驶 : 当 障碍 物 或 者 车 辆 使 得 道路 阻塞 时 ， 驾 
了 驶 行为 将 另 选择 适当 的 道路 在 十 字 路 口 的 三 种 运动 行为 优先 、 并 入 、 左 转 。 他们 
设计 的 驾驶 行为 能 够 处 理 不 断 变化 的 有 噪声 的 , 不 完整 数据 和 非 瞬 间 的 上 层 决 
策 的 控制 。 由 于 没有 统一 规划 模块 而 且 各 个 单元 及 行为 的 控制 是 共享 的 , 所 以 协 
调 变 得 极为 重要 。 因 此 ， 系 统 使 用 了 一 种 行为 选择 的 仲裁 方法 ,解决 可 能 出 现 的 
行为 冲突 ， 这 种 方法 包括 一 种 改进 winner-takes-all 机 制 和 一 个 分 层 有 限 状态 机 。 
运动 控制 系统 规划 一 个 独立 于 平台 的 命令 系列 ， 包 括 所 需 的 曲率 、 曲 率 变化 、 做 
大 加 速度 、 速 度 及 每 个 命令 的 时 间 。 其 中 速度 是 PID 闭环 控制 ， 转 向 控制 依赖 
于 一 个 标准 的 环 路 模型 估计 车 辆 的 曲率 响应 。 

另 一 车 队 Talos 则 是 根据 导航 器 输出 的 路 径 和 低级 控制 器 输出 的 速度 命令 。 
使 用 基于 快速 扩展 随机 树 (RRT) (LaValle and Kuffner, 2001) 的 方法 通过 随机 的 无 
数 样本 点 生成 动态 轨迹 可 行 树 。 并 对 典型 RRT 进行 了 一 些 扩展 (Frazzoli, 2001)。 
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第 一 个 扩展 是 从 控制 器 的 输入 抽样 和 运行 闭环 仿真 。 另 一 种 扩展 RRT 算法 是 利 
用 环境 的 物理 逻辑 结构 进行 偏 性 2D 采样 并 用 于 形成 转向 控制 器 的 输入 。 它 的 控 
制 器 由 两 部 分 组 成 ， 一 个 纯 跟踪 式 转向 控制 器 和 比例 积分 (PD 速度 控制 器 。 用 一 
个 纯 跟 踪 式 算法 实施 转向 控制 ， 长 期 以 来 ， 无 论 对 于 地 面 车 辆 还 是 飞机 , 它 都 显 
示 了 优良 的 追踪 性 能 一 个 简单 的 PI 控制 器 被 用 于 跟踪 预定 的 速度 。 这 两 个 核心 
模块 不 仅 嵌 入 了 执行 控制 器 , 也 在 预测 轨迹 的 运动 规划 器 里 。 生 成 的 控制 信号 被 
发 送 到 驱动 的 ADU 中 ， 并 且 控制 器 回路 以 25 赫兹 运行 (Park et al., 2007)。。 

在 车 辆 的 控制 方式 上 ， 郭 孔 辉 (1991) 院 士 提出 了 基于 “ 预 瞄 一 跟随 "的 控制 模 
型 。 这 个 模型 的 基本 特点 是 : 驾驶 员 在 驾驶 车 辆 时 ， 能 够 自动 地 跟随 期 望 轨迹 。 
王 荣 本 ， 游 峰 ， 张 荣 辉 (2001) 等 人 对 于 视觉 引导 的 智能 车 辆 , 自由 度 动力 学 
模型 和 车 辆 预 瞄 运动 学 模型 为 标 称 模型 ， 分别 采用 最 优 控制 、 寞 类 控制 和 滑 模 变 
结构 控制 的 方法 ， 结 合 视觉 传感器 ， 实 现 了 跟随 车 道 线 的 控制 ( 张 荣 辉 2007; E 
荣 本 ,等 ，2007)。 游 峰 针对 具体 的 超车 任务 ， 以 车 辆 轨迹 跟踪 误差 的 收敛 性 为 目 
标 ， 采 用 基于 backstepping 方法 ， 设 计 了 针对 超车 任务 的 轨迹 跟踪 算法 ( 游 
峰 ,2005)。 任 典 波 ， 张 继 业 等 人 同样 针对 超车 任务 ， 根 据 车 辆 期 望 运动 状态 计算 
了 换 道 时 的 期 望 横 摆 角 ， 模 摆 角速度 和 角 加 速度 ,采用 了 非 奇 异 终端 滑 模 控制 方 
法 ， 设 计 了 清 模 控 制 规律 ( 任 典 波 ,等 ，2011)。 高 锋 ， 李 克 强 等 学 者 考虑 了 车 辆 纵 
向 运动 模型 不 可 确定 的 特点 , 采用 了 多 模型 分 层 切换 控制 的 方法 , 该 方法 基于 名 
棒 控 制 理论 ， 并 且 ， 进 行 了 理论 上 的 分 析 及 仿真 实验 (Gao Feng, et al.,2006)。 

在 这 一 研究 方向 , 基本 目的 是 要 提高 车 辆 控制 算法 精确 性 、 鲁 棱 性 和 对 不 同 
路 况 的 自 适应 能 力 。 首先 需要 从 非 线性 系统 稳定 性 分 析 的 角度 , 研究 车 辆 对 轨迹 
跟踪 误差 的 收敛 性 ， 这 是 车 辆 能 够 实现 对 轨迹 跟踪 的 前 提 。 其 次 ， 还 需要 研究 重 
棒 性 强 以 及 具备 环境 自 适 应 能 力 的 控制 算法 , 以 保证 车 辆 工 况 大 范围 变化 时 的 控 
制 性 能 。 最 后 ， 要 扩展 车 辆 运动 控制 的 功能 ， 能 够 使 车 辆 完成 泊 车 、 超 车 、 汇 入 
车 流 等 不 同 的 任务 。 

我 国 相关 技术 研究 开展 得 较 晚 ,与 西方 国家 存在 很 大 差 虹 ,在 面向 汽车 主动 
安全 的 智能 驾驶 技术 方面 , 国防 科技 大 学 相对 处 于 国内 领先 的 地 位 , 该 校 于 2003 
年 联合 研制 成 功 “ 红 旗 旗 舰 " 自 主 驾 驶 系统 .该 系统 采用 PI 横向 控制 和 非 线性 PID 
纵向 控制 ， 在 高 速 公路 环境 简单 ,道路 情况 变化 小 ,干扰 少 的 情况 下 容易 获得 很 
好 的 效果 。 但 在 复杂 的 城市 环境 中 ， 常 规 的 PID 控制 算法 将 会 带 来 参数 优化 的 
困难 ， 而 使 控制 效果 欠 佳 ， 无 法 自动 环境 适应 变化 。 

我 国 在 2009 年 和 2010 年 也 分 别 举办 了 “智能 车 未 来 挑战 赛 "参赛 队伍 包括 
武汉 大 学 、 湖 南大 学 、 装 甲 兵 工 程 学 院 、 军 事 交通 学 院 、 中 国 科学 院 合肥 物质 科 
学 研究 院 、 清 华 大 学 、 国 防 科学 技术 大 学 、 西 安 交通 大 学 、 南 京 理工 大 学 、 北 京 
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理工 大 学 10 支 代表 队 。 从 比赛 中 可 以 很 好 地 看 出 我 们 技术 水 平 的 缺陷 。 在 横向 
控制 方面 ， 算 法 较为 简单 ， 考 虑 情况 不 够 充分 ， 导 致 重 棒 性 较 差 ， 在 有 干扰 时 或 
高 速 行驶 时 会 发 生 震 荡 ; 在 纵向 控制 中 , 精度 不 够 使 得 泊 车 定点 控制 和 车 速 的 准 
确 控制 成 为 难点 。 整体 系统 对 于 不 同 路 况 的 适应 性 较 差 , 因而 在 系统 必须 人 为 设 
定 状况 切换 使 得 在 不 同道 路 下 如 曲线 和 直线 道路 ) 分 别 使 用 不 同 的 控制 策略 ， 
从 而 设计 自 适应 控制 器 。 在 自 适应 PD 控制 器 中 ， 通 过 根据 系统 状态 、 对 象 特 
性 的 变化 而 改变 PID 参数 ， 以 获得 更 好 的 控制 效果 。 目 前 已 提出 的 自 适应 PID 
控制 方法 主要 有 模型 参考 自 适应 控制 (Byme.R.H. 1995; Wei Wang,et al.,2006; 
LiZ., et al,2011)， 模 糊 自 适应 PID 控制 (Hessburg, T. 1994,; Choomuang R,et 
由 ,2005)， 基 于 神经 网 络 的 自 适应 PID 控制 (Park PC,et al.,1989; Puntunan S.,et 
世 ,2006) 和 甘于 进化 算法 的 自 适应 PID 控制 器 (Doi Masayoshi, et al., 2011.) 等 。 另 
外 ， 人 类 驾驶 员 行为 的 分 析 方 法 和 建 模 方法 也 是 我 们 需要 学 习 研究 的 内 容 。 


14 本 文 主要 研究 内 容 及 研究 意义 


以 “智能 先锋 "无 人 驾驶 车 辆 平台 为 基础 , 介绍 了 平台 的 感知 系统 、 决策 系统 、 
控制 系统 及 执行 机 构 , 介 绍 了 城市 道路 的 环境 特点 ,结合 驾驶 员 的 驾驶 行为 方式 ， 
提出 了 无 人 驾驶 车 辆 在 城市 道路 运动 控制 方面 过 到 的 关键 性 问题 和 采用 的 研究 
策略 。 

研究 车 辆 纵向 动力 学 控制 方法 , 研究 车 辆 动力 传动 特性 和 制 动 力学 特性 , 结 
合 汽车 动力 学 系统 强 非 线性 的 特点 ， 在 传统 PID 控制 基础 上 结合 专家 控制 系统 
的 思想 ， 提 出 了 专家 PID 控制 算法 ， 控 制 车 辆 加 速度 。 建 立 了 刹车 和 油门 的 切 
换 控制 逻辑 ， 使 控制 系统 能 够 在 两 种 控制 输入 条 件 下 平滑 的 切换 ， 并 解决 在 传动 
系统 高 度 非 线性 和 复杂 的 纵向 干扰 条 件 下 的 控制 精度 的 问题 , 实现 无 人 驾驶 车 辆 
在 道路 行驶 的 速度 控制 。 

研究 基于 车 辆 操纵 动力 学 的 横向 控制 方法 。 建立 车 辆 操纵 动力 学 模型 , 进行 
车 辆 操纵 动力 学 和 轮胎 侧 向 力学 分 析 ， 在 “ 预 瞳 一 跟随 "理论 的 控制 模型 的 基础 
上 ， 针 对 城市 道路 环境 复杂 多 样 的 情况 ， 设 计 了 一 种 小 脑 模型 神经 网 络 与 PID 
复合 的 横向 控制 器 ， 对 不 同 的 环境 信息 和 不 同 轰 驶 模式 分 别 进行 系统 参数 优化 ， 
从 而 使 无 人 驾驶 车 辆 能 够 灵活 的 在 各 种 道路 环境 中 实现 稳定 准确 的 道路 跟踪 行 
驶 并 具有 较 强 的 鲁 棒 性 。 

研究 车 辆 高 速 行驶 时 的 运动 学 特性 , 联合 考虑 纵向 控制 和 横向 控制 之 间 相互 
制约 关系 ， 重 点 研究 车 辆 高 速 行驶 时 的 安全 性 。 

本 文 最 后 在 “智能 先锋 "无 人 驾驶 车 辆 平台 上 验证 了 上 述 研究 内 容 的 有 效 性 


u 
sise 000000 


第 一 章 绪论 





和 可 靠 性 , 并 根据 实验 结果 总 结 了 目前 控制 系统 设计 方法 的 优势 和 不 足 , 对 进 一 
步 的 研究 提出 了 展望 。 
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第 二 章 城市 环境 下 无 人 驾驶 车 辆 控制 系统 的 设计 分 析 


本 章 首先 介绍 了 城市 环境 的 道路 特点 ,结合 驾驶 员 对 车 辆 的 控制 方式 , 提出 
了 无 人 驾驶 车 辆 在 城市 道路 运动 控制 方面 过 到 的 关键 性 问题 。 然 后 ， 介 绍 了 “ 智 
能 先锋 "无 人 驾驶 车 辆 平台 的 体系 结构 及 感知 系统 、 决 策 系统 、 控 制 系统 和 执行 
机 构 各 子 系统 的 硬件 组 成 及 功能 。 最 后 盖 述 了 本 文 所 采用 的 控制 系统 研究 策略 。 


21 城市 环境 中 无 人 驾驶 车 辆 所 面临 的 问题 


2.1.1 城市 道路 环境 特点 


我 国 城市 道路 的 等 级 分 类 主要 有 快速 公路 、 主 干道 、 次 干道 和 支 路 四 种 ( 文 
国 玮 ,2005)。 车 辆 行驶 在 不 同等 级 的 道路 所 要 遵循 的 交通 规则 是 不 同 的 。 对 道路 
等 级 的 准确 认 知 , 是 驾车 在 道路 中 行驶 的 前 提 工 作 。 在 不 同类 型 的 道路 中 交通 规 
则 要 求 不 同 , 行驶 环境 条 件 的 不 同 ,驾驶 员 的 驾驶 行为 特征 与 注意 力 焦点 也 是 不 
尽 相同 的 。 

快速 路 是 车 辆 行驶 时 ， 速 度 可 以 达到 较 高 范围 的 道路 ， 是 车 辆 专 行道 路 , 一 
般 在 快速 路 行驶 的 速度 限制 为 60-80 公里 /小 时 。 驾 驶 员 在 这 种 道路 上 行驶 时 ， 
速度 一 定 要 快 ， 一般 没有 交通 信号 灯 , 同时 也 没有 非 机 动车 或 者 一 些 道路 基础 设 
施 干扰 ， 驾 驶 员 的 视线 较为 清楚 。 驾驶 员 在 没有 外 部 干扰 的 情况 ， 在 快速 路 上 应 
当 快速 地 通过 。 

主干 道 的 设计 目的 是 以 普通 交通 通行 为 主 ， 车 辆 的 行驶 速度 一 般 限制 在 
40-60 公里 /小 时 。 主 干道 的 设计 时 速 比 快速 路 要 低 ， 因 为 它 主要 承担 着 连接 快速 
路 与 低速 路 的 责任 。 驾驶 员 行驶 在 主干 道 时 ， 处 于 主要 的 地 位 ， 应 在 速度 限制 范 
围 内 快速 地 通过 。 行 驶 期 间 ， 多 数 十 字 路 口 会 设置 红绿灯 ， 车 辆 应 遵守 交通 信号 
指示 。 在 主干 道上 行驶 了 时， 其 有 隔离 措施 ， 通 行 速度 高 低 不 均 ， 有 可 能 会 遇 到 堵 
车 的 现象 。 在 路 口 时 ， 由 于 一 些 车 辆 可 能 会 需要 变更 车 道 , 续 而 可 能 引起 交通 冲 
突 ， 甚 至 造成 一 些 安全 事故 。 

次 干道 是 一 种 具有 服务 功能 的 交通 集散 道路 , 它 主要 负责 承接 主干 道 与 各 生 
活 工作 区 域 的 道路 。 车 辆 在 次 干道 必须 以 低速 行驶 ， 其 行驶 速度 一 般 限 制 在 40 
公里 /小 时 以 内 , 在 支 路 的 行驶 速度 限制 在 30 公里 /小 时 以 内 。 这 两 种 道路 的 主要 
功能 是 使 非 机 动车 优先 通行 , 多 见于 居民 居住 区 内 , 并 且 道路 中 分 离 设 施 不 完备 ， 
同时 交通 情况 较为 复杂 ,道路 上 行人 来 往 密集 ， 车 辆 与 非 机 动车 交错 行驶 。 驾驶 
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员 驾 车 行驶 在 道路 上 ， 应 特别 注意 周边 环境 及 各 种 突 发 情况 。 
交叉 路 口 是 城 市 道路 的 重要 组 成 部 分 , 它 也 是 交通 冲突 、 道路 拥堵 和 交通 事 
故 的 主要 发 生地 。 据 交通 部 门 统计 ,在 城市 道路 发 生 的 交通 事故 中 ,路口 事 故 占 
60% 以 上 。 
从 形态 上 分 城市 道路 交叉 路 口 有 平面 交叉 路 口 和 立体 交叉 路 口 两 种 , 立体 交 
叉 路 口 可 以 有 效 的 提高 路 口 的 通行 能 力 , 能 够 彻底 解决 道路 交叉 冲突 ,但 由 于 立 
体 交叉 路 口 的 设计 和 实施 会 受 城市 道路 面积 和 建筑 成 本 的 限制 ， 尚 无 广泛 应 用 。 
平面 交叉 口 路 口 包 括 ; 三 叉 口 、 四 叉 口 、 多 支 路 丸 口 和 环 型 路 口 等 。 路 口 的 交通 
冲突 量 的 多 少 随 路 口 的 叉 路 数 的 增加 为 增加 。 若 交叉 路 口 的 叉 路 数 为 五 , 其 交通 
冲突 的 个 数 将 高 达 52 个 。 行 驶 通过 平面 交叉 路 口 时 ， 应 当 严格 遵守 交通 信号 灯 
的 指示 ,并 时 刻 注意 各 个 方向 的 来 往 车 辆 及 行人 ,以 防 因 速度 偏差 等 因素 而 增生 
的 交通 冲突 (全 永 桑 ，1989)。 
城市 道路 的 特点 一 般 是 : 道路 分 类 多 样 ， 车 流 混杂 ， 行 人 非 机 动车 辆 多 ， 车 
辆 类 型 多 样 ， 交 通 的 组 织 较 复杂 ,道路 交叉 多 ,交通 冲突 多 易 拥堵 ， 交 通 流速 组 
慢 通 行 能 力 较 低 。 根 据 不 同城 市 交通 规划 的 不 同 ， 城 市 道路 网 的 特点 也 有 不 同 。 
在 我 国 ， 城 市 交通 主要 有 以 下 几 个 特点 ; 
1) 城市 多 为 紧密 型 的 分 布 ， 城 区 密集 人 口 密度 大 ， 相 对 路 网 建设 不 完善 ， 
难以 适应 城市 汽车 数量 的 急剧 上 升 ， 导 致 城市 道路 通行 压力 大 。 
D 交通 结构 复杂 行人 、 非 机 动车 辆 、 机 动车 和 其 他 特殊 车 辆 等 各 种 交通 
流 相互 交错 。 
3) 市 民 交 通 意识 差 、 交 通 参与 人 尤其 车 辆 驾驶 员 违章 现象 时 有 发 生 。 在 各 
种 交通 车 辆 混 行 道路 上 行驶 应 保持 警惕 。 
以 上 是 我 国 城市 道路 交通 的 主要 特点 , 也 造成 城市 道路 行驶 的 交通 安全 和 交 
通 管理 方面 的 各 种 难题 。 除 此 之 外 ,在 错综复杂 的 城区 道路 中 ， 车辆 的 安全 通行 
还 需要 清晰 合理 的 车 道 线形 、 隔 离 清晰 的 路 沿路 面 、 视 野 开阔 的 道路 交口 以 及 完 
整 感觉 的 隧道 。 但 实际 驾驶 时 ， 总 会 有 一 些 不 尽 如 入 意 的 道路 条 件 ， 例 如 车 道 线 
中 断 、 交 叉 口 路 边 有 障碍 物 遮 挡 视线 等 情况 , 这 些 也 都 对 驾驶 员 在 行驶 过 程 中 带 
来 难题 。 


212 驾驶 员 在 城市 道路 中 行驶 所 要 完成 的 任务 


驾驶 员 操纵 汽车 的 行为 是 对 汽车 的 方向 与 速度 进行 调节 以 使 汽车 安全 前 进 ， 
包括 驾驶 员 对 道路 交通 环境 的 感知 ,对 汽车 可 行 区 域 的 规划 处 理 , 对 汽车 预期 轨 
迹 的 预测 和 决策 以 及 对 车 辆 方向 盘 、 档 位 、 油 门 、 制 动 的 操作 及 其 控制 校正 等 。 
驾驶 员 在 行驶 过 程 中 的 主要 任务 包括 : 
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D 根据 道路 的 标 线 规定 ， 包 括 车 道 分 界线 、 导 向 车 道 线 、 导 向 箭头 、 停 止 
线 、 人 行 模 道 线 等 ， 驾 驶 车 辆 在 正确 的 车 道内 行驶 。 

2) 根据 道路 的 速度 限制 规定 和 车 流 人 流通 行 的 情况 、 路 面 状况 和 天 气 情况 ， 
合理 控制 行驶 速度 。 

3) 根据 车 辆 的 车 速 、 道 路 、 地 形 等 变化 ， 合 理 控制 行驶 间距 和 行驶 的 横向 
ER. 

4) 在 会 车 、 让 车 或 超车 过 程 中 ， 驾 驶 员 必 须根 据 车 辆 的 位 置 和 速度 照顾 到 
前 后 及 两 侧 的 情况 ， 提 前 打开 转向 灯 ， 合 理 控制 车 速 寻 找 并 道 机 会 。 

5 通过 路 口 需要 遵守 交叉 路 口 的 标志 牌 及 信号 灯 的 指示 ， 行 近 路 口 时 需要 
提前 减速 , 并 以 不 超过 20kmh 的 速度 通过 路 口 。 同 时 要 随时 注意 避让 行 
人 和 其 他 有 先行 权 的 车 辆 。 


2.1.3 结合 驾驶 员 驾 驶 行为 提出 无 人 驾驶 车 辆 所 面临 的 问题 


结合 城市 公路 环境 下 车 辆 运动 控制 问题 的 特点 , 本 文 所 研究 的 无 人 驾驶 车 辆 
控制 系统 主要 面临 以 下 问题 : 

1) 本 文 所 讨论 的 城市 道路 环境 具有 明显 的 结构 化 道路 特征 ， 例 如 车 道 线 ， 
斑马 线 ， 红 绿灯 等 外 部 环境 信息 。 在 这 种 特定 的 条 件 下 ， 无 人 驾驶 车 辆 
的 决策 系统 的 规划 与 控制 方法 的 选择 都 要 受到 环境 的 制约 ， 这 需要 我 们 
能 够 对 这 种 结构 化 环境 带 来 的 约束 进行 定量 的 描述 ， 从 而 能 用 数学 语言 
来 描述 决策 制定 。 

无 人 轰 驶 车 辆 的 最 终 设计 目标 是 使 得 车 辆 能 够 像 驾 驶 员 "一 样 驾 驶 车 
辆 ， 到 达 目 的 地 ， 这 就 需要 在 车 辆 决策 与 控制 方法 的 设计 上 ， 最 大 程度 
的 “拟人 化 "， 例 如 ， 控 制 系统 在 控制 车 辆 执行 转向 时 ， 应 该 像 经 验 丰富 
的 驾驶 员 一 样 ， 平 稳 地 控制 转向 。 但 是 ， 现 有 的 无 人 驾驶 车 辆 研究 理论 
并 不 能 取得 很 好 的 结果 。 

在 城市 道路 环境 中 ， 不 同等 级 的 道路 对 车 辆 速度 的 限制 不 尽 相 同 ， 这 就 
需要 无 人 驾驶 车 辆 的 纵向 和 横向 控制 器 的 控制 结果 准确 、 及 时 并 具有 自 
适应 性 和 鲁 棒 性 。 


2 


3 


22 “智能 先锋 "无 人 车 体系 结构 及 功能 


中 科 院 合肥 物质 科学 研究 院 自 2008 年 起 开展 面向 城市 综合 环境 的 无 人 驾驶 
车 辆 关键 技术 及 平台 的 研究 , 并 成 功 研制 了 具有 环境 感知 、 路 径 规划 、 行为 决策 、 
自主 控制 能 力 的 智能 车 辆 平台 一 “智能 先锋 ”"。 并 在 国家 基金 委 举 办 的 2010 及 


5 
sise 000000 


第 二 章 ”城市 环境 下 无 人 室 驶 车 辆 控制 系统 的 设计 分 析 





2011 广汽 丰田 杯 "智能 车 未 来 挑战 赛 "中 分 别 获得 第 一 名 和 第 三 名 。 

“智能 先锋 "无 人 驾驶 汽车 系统 总 体 结构 采用 分 布 式 结构 ,主要 由 环境 感知 系 
统 、 决 策 系统 、 传 感 器 子 系统 、 车 辆 控制 系统 、 车 辆 执行 机 构 组 成 ， 各 个 子 系统 
之 间 除 车 辆 操作 接口 子 系统 之 外 ， 全 部 采用 以 太 网 连接 ， 以 保证 高 速 、 可 靠 的 数 
据 传输 。 图 2.1 表示 了 无 人 车 系统 的 硬件 框图 。 
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感知 系统 : 针对 城市 复杂 交通 环境 , 选用 三 维 激光 雷达 进行 城市 复杂 环境 三 
维 建 模 , 使 用 二 维 激光 雷达 和 相机 信息 的 融合 进行 障碍 物 、 车 道 和 交通 标识 的 快 


速 检测 和 准确 识别 ， 使 用 毫米 波 雷达 进行 动态 目标 及 其 速度 的 检测 。 


使 用 GPS/INS 组 合 导航 系统 、 诸 坊 航向 参考 系统 (AHRS) 和 高 精度 里 程 计 
组 成 无 人 驾驶 车 辆 定位 模块 , 进行 无 人 轰 驶 车 辆 的 航 迹 推算 和 定位 。 传感器 安装 


如 图 2.2 所 示 。 


配备 了 多 台 激光 传感器 ,视觉 相机 ， 并 且 配 备 了 两 台 计算 机 ， 用 来 接收 ， 处 


理 传感器 所 传递 的 原始 数据 。 传 感 器 配置 如 表 2.1 所 示 : 



































#21 传感器 配置 
EEEN |% ; 
号 量 | . 特性 用 途 
EMME: Tem 
加 度 精度 :0.02m/s RMS 
SPAN-CPT | 1 | 位 交 精 度 : 005 度 (多 全 横流)，| BEM OPS 
OIE FUA) 
剧 新 率 : 5Hz 
odre | | 360x26- 度 范围 (FOV》 角度 分 | 全 向 立体 探 
EDÉM | 1 [ako 测 , 近 距 高 障 
ps 70m 最 大 量程 码 物 检测 
SICK 
LMS 180 deg x 0.9 deg 视 野 (FOV)， | 全 向 , 中 距离 
291-S05 | 5 | 角度 分 辩 率 1 度 RA, 
LIDAR 80-m BARE. 
(LMS) 
Point Grey an 
n 高 动态 范围 相机 前 后 视 , 远 距 
Firefly | 4 | 45-deg 视野 (FOV) 离 探测 
(PGF) 一 E 
Delphi 3 
ESR 2 WWE: 174m, FOV: +/-10 度 ， pears 
BAER 更 新 率 ，50ms can 
达 
TE: OARD, BUR), 
AR | 1 | 07 度 (方位 角 ) iter 
刷新 率 : 1-100Hz 
TBR SHAK, AB 
rests |, | RRR, waRCo ne | 精确 测量 车 
器 0.smm， 在 高 低速 工 况 下 ， 数 | STEER 
据 准 确 可 靠 
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决策 系统 : 通过 周边 环境 识别 的 结果 ,通过 span-cpt 的 定位 信息 及 轮 速 传 感 
器 的 辅助 对 当前 所 处 环境 进行 任务 上 地 划分 判断 , 实时 地 规划 出 路 径 并 且 跟 踪 路 
径 ,计算 出 的 控制 目标 通过 以 太 网 络 发 送 给 控制 系统 ， 最 终 ， 通 过 can 网 络 发 送 
至 相应 电机 执行 动作 。 

智能 决策 是 无 人 车 研究 的 一 个 核心 问题 。 它 是 无 人 车 的 大 脑 , 其 目标 是 在 存 
在 障碍 物 的 复杂 交通 环境 中 ， 为 无 人 车 寻找 一 条 满足 车 辆 控制 约束 、 无 碰撞 、 甚 
至 符合 交通 规范 的 路 径 。 

总 体 结构 框图 如 图 NR: 





图 2.2 决策 系统 结构 框图 


控制 系统 : 采用 CAN2.0B 总 线 构建 车 辆 控制 系统 网 络 ， 通 过 CAN 网 关 和 
车 身 CAN 网 络 通讯 ,建立 基于 CAN 总 线 的 无 人 驾驶 车 辆 分 布 式 自动 控制 系统 
各 控制 对 象 和 状态 检测 单元 通过 CAN 总 线 接 入 控制 系统 ， 控 制 系统 计算 机 可 以 
通过 车 身 CAN 总 线 直 接 获取 车 辆 的 状态 信息 ， 并 通过 CAN 总 线 将 控制 指令 发 
往 各 控制 对 象 ， 实 现 对 车 辆 转向 、 制 动 、 油 门 、 档 位 ， 以 及 灯光 和 喇叭 的 控制 。 

车 辆 执行 机 构 :“ 智 能 先锋 "是 以 奇瑞 瑞虎 3 为 基础 研制 的 , 瑞虎 3 紧凑 简洁 
的 独立 悬 架 系统 使 整 车 具有 良好 的 行驶 稳定 性 能 和 通过 性 , 全 部 由 奇瑞 公司 自主 
研发 的 车 载 网 络 系统 ， 使 车 辆 具有 很 好 的 可 扩展 性 ， 各 种 传感器 、 执 行 器 可 以 做 
成 CAN 节点 形式 ， 方 便 地 接 入 网 络 ， 实 现 系 统 集成 。 车 辆 控制 系统 包括 转向 控 
制 、 制 动 控制 、 油 门 控制 、 档 位 控制 、 灯 光 和 喇叭 控制 等 。 

车 辆 控制 系统 的 设计 原则 : 

1) 安全 原则 : 所 有 附加 机 构 不 影响 原 车 辆 的 控制 性 能 , 保证 车 辆 操控 安全 ; 

车 载 电 源 不 高 于 24V， 保 证 用 电 安全 ; 
2) 便利 原则 : 能 够 方便 地 实现 手 自动 切换 。 
转向 控制 : 对 原 转向 柱 进行 改造 , 通过 大 功率 伺服 电机 实现 快速 准确 的 转向 
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控制 ， 如 图 2.3 所 示 。 
制 动 控制 : 通过 附加 的 踏板 机 构 , 制 动 控制 采用 齿轮 齿 条 配合 控制 制 动 路 板 
实现 ， 如 图 2.4 所 示 。 





图 2.3 转向 机 构 图 2.4 制 动 机 构 


油门 控制 ;通过 电子 油门 直接 控制 发 动机 电子 节气 门 的 开 度 实现 控制 车 速 ， 
如 图 2.5 所 示 。 
档 位 控制 ， 采用 精密 电 控 位 移 台 ， 如 图 2.6 所 示 。 


图 2.5 油门 控制 图 2.6 换 档 机 构 





喇叭 和 各 种 灯光 的 控制 均 采用 直接 控制 车 身 电路 的 方式 实现 。 
电源 系统 采用 分 模块 供电 方式 , 各 模块 设置 独立 的 电源 开关 和 保护 装置 , 如 
图 2.7 所 示 。 
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FT 
图 2.7 车 辆 平台 电源 系统 


2.3 ”控制 系统 设计 方法 和 设计 指标 


控制 系统 的 功能 是 将 来 自决 策 系统 产生 的 路 径 规划 轨迹 转化 为 各 执行 机 构 
动作 ， 并 控制 各 执行 机 构 完 成 相应 动作 ， 实 现 对 路 径 及 速度 的 准确 平稳 的 跟踪 。 
它 是 整个 无 人 驾驶 车 辆 系统 的 最 底层 ， 由 一 系列 传统 控制 律 和 逻辑 推理 算法 组 
成 ， 其 中 包括 车 速 控制 、 方向盘 控 制 、 刹 车 控制 、 档 位 控制 、 灯 光 、 喇 叭 控制 器 
等 组 成 。 为 了 确定 执行 路 径 跟 踪 的 控制 律 相关 的 参数 ,我 们 首先 需要 规定 车 辆 期 
望 行驶 轨迹 和 状态 的 表达 方式 。 根据 给 定 的 期 望 轨迹 ， 控制 系统 将 采用 预 瞄 一 跟 
随 控制 策略 ， 即 指定 给 定 轨迹 中 的 一 点 ,通过 计算 该 点 和 车 辆 的 相对 位 置 ， 并 根 
据 车 辆 当前 速度 ， 确 定 方向 盘 转角 信号 ， 使 车 辆 向 该 点 移动 。 通 过 轨迹 的 更 新 ， 
PAM, 重复 这 一 过 程 ,实现 车 辆 对 横向 运动 的 控制 。 根 据 给 定 的 期 望 束 
度 , 控制 系统 将 选择 相应 的 控制 律 并 在 一 定 的 安全 约束 下 控制 其 加 速度 ,并 建立 
相应 的 刹车 和 油门 的 切换 控制 规则 ， 实 现 车 辆 对 速度 的 平稳 跟踪 。 


231 行驶 路 径 的 表述 


从 整 车 系统 来 看 ， 上 文 提 到 “智能 先锋 "的 系统 结构 分 为 感知 系统 ， 决 策 系 
统 和 控制 系统 , 其 软件 结构 如 图 2.8 所 示 . 系统 从 环境 获得 的 感知 信息 主要 包括 : 
1) 全 局 道路 信息 : 比赛 规则 组 在 赛 前 提供 路 网 定义 文件 RNDF)， 我 们 根据 
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RNDF 确定 全 局 道路 和 交叉 口 的 几何 信息 ， 产 生 全 局 路 径 地 图 。 

2) 局 部 道路 信息 : 感知 系统 通过 摄像 机 、 二 维 激光 、 三 维 激光 采集 数据 , 
产生 一 副 512*512 的 二 维 杨 格 地 图 ， 该 地 图 能 够 描述 车 辆 周围 50*50m 
的 可 通行 道路 ， 车 道 线 ， 障 碍 物 分 布 情况 ， 此 外 还 有 通过 摄像 机 采集 到 
的 道路 交通 标志 信息 。 

3) 车 辆 定位 信息 : 无 人 车 可 以 采用 GPS 定位 ， 同 时 车 辆 配备 了 轮 速 传感器 
和 航 变 基准 系统 (AHRS)， 用 来 在 保障 失去 GPS 或 不 依赖 GPS 时 确定 车 


辆 的 位 置 变 态 和 速度 信息 。 

其 中 ， 决 策 系统 的 路 径 规划 模块 负责 产生 由 车 辆 初始 点 到 目标 点 的 预测 轨 
迹 , 并 根据 环境 信息 的 改变 来 更 新 车 辆 的 轨迹 ,这些 轨 迹 经 过 相应 的 平滑 处 理 后 
可 以 满足 车 辆 的 动态 可 行 性 。 我 们 将 该 轨迹 表示 为 一 系列 离散 点 的 集合 ， 参 数 
点 x 表示 车 辆 的 行驶 状态 


x=[x y OF en 
其 中 (xy 为 车 辆 位 置 ，6 为 车 辆 的 航向 角 。 根 据 感知 信息 范围 ， 该 轨迹 长 度 
最 长 为 50m。 除 了 生成 路 径 外 ， 决 策 系统 还 生成 其 他 的 指令 如 行驶 速度 ， 行 驶 状 
态 〈 直 行 、 转 弯 、 停 车 等 )， 这 些 指令 将 以 10Hz 的 频率 发 送 至 控制 系统 。 根 据 
这 种 轨迹 生成 的 方式 , 控制 系统 可 以 产生 相应 一 系列 的 控制 参数 以 满足 上 述 状态 
Xo 图 2.8 描述 了 常见 的 城市 环境 道路 及 其 通过 决策 系统 规划 出 的 路 径 结果 。 


pies 





图 2.8 城市 环境 基本 路 况 路 径 规划 示意 图 


本 文 将 无 人 驾驶 车 辆 的 运动 控制 分 解 为 横向 控制 和 纵向 控制 .横向 控制 是 对 
车 辆 方向 盘 的 转角 的 控制 ， 从 而 使 车 能 够 沿 着 期 望 的 路 径 行驶 ， 而 纵向 控制 控制 
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使 对 刹车 、 油 门 以 及 档 位 的 位 置 的 控制 ， 目 的 是 让 车 能 够 按照 期 望 的 速度 行驶 。 
23.2 纵向 控制 


无 人 驾驶 车 辆 的 纵向 控制 主要 研究 如 何 控制 车 辆 纵向 运动 , 即 控制 车 辆 按照 
期 望 的 速度 行驶 ， 控 制 车 辆 间距 离 ， 控 制 车 辆 的 纵向 加 速度 ， 控 制 节气 门 的 开 度 
和 制动器 的 制 动 量 以 及 两 者 之 间 的 切换 。 图 2.10 是 关于 车 辆 的 纵向 控制 。 如 今 
定 速 巡航 控制 系统 已 经 作为 大 多 数 车 辆 的 标准 配置 , 利用 该 系统 ,驾驶 员 可 以 为 
车 辆 设置 希望 的 恒定 行驶 速度 , 定 速 巡航 控制 系统 通过 控制 节气 门 能 够 使 车 辆 自 
动 保持 所 设 定 的 速度 行驶 。 标 准 的 巡航 控制 系统 的 设计 一 般 为 分 层 控制 结构 
(Liang, C.Y., et al, 1999; Guvenc, B. A.et al., 2006), 如 图 2.11， 上 层 控制 器 决定 车 
辆 的 加 速度 期 望 值 ， 下 层 控制 器 决定 达到 期 望 加 速度 值 所 需要 的 节气 门 输入 量 ， 
并 使 用 车 辆 动力 学 模型 、 发 动机 MAP 图 、 非 线性 控制 综合 技术 来 计算 跟踪 设 定 
加 速度 值 所 需 的 实时 节气 门 输入 量 , EARNERS, 定 速 巡 航 控制 一 般 用 于 高 
速 公路 ， 而 在 城市 道路 环境 下 ， 由 于 其 外 部 环境 变化 复杂 ， 突 发 情况 较 多 ， 需 要 
频繁 改变 车 速 限制 了 定 速 巡 航 控制 的 使 用 , 驾驶 员 需 要 根据 环境 的 变化 来 控制 车 
速 。 
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图 2.10 闭环 速度 控制 框图 
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图 2.11 巡航 控制 结构 示意 图 
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对 于 城市 道路 环境 中 的 无 人 驾驶 车 辆 控制 系统 , 纵向 控制 的 设计 目的 是 要 使 
车 辆 具有 以 下 性 能 : 
1) 准确 性 :建立 车 辆 纵向 动力 学 ， 计 算 达到 期 望 加 速度 值 所 需要 的 节气 门 
或 制动器 的 输入 量 ， 保 证 速度 控制 的 稳 态 误差 为 零 ， 并 且 有 较 快 的 用 应 
时 间 。 
2) 平稳 性 ， 加 速度 太 大 或 变化 不 平滑 ， 使 车 身 产生 同 振 或 冲击 ， 控 制 系统 
应 当 使 得 加 速度 的 变化 更 加 平顺 ， 不 能 过 大 ， 造 成 车 辆 突然 加 速 ， 使 乘 
客 产生 不 适 感 ， 力 求 加 速度 变化 产生 的 影响 最 小 。 
3) 适应 性 : 城市 环境 中 ， 常 常 需要 频繁 改变 车 速 ， 同 时 车 辆 的 纵向 动力 特 
性 受 外 部 输入 条 件 影响 较 大 ， 如 路 面 附着 系统 、 道 路 的 起 伏 及 天 气 条 件 
等 。 因 此 纵向 控制 系统 必须 有 较 强 的 鲁 棒 性 和 适应 性 。 
结合 上 述 无 人 驾驶 车 辆 控制 系统 的 性 能 要 求 ， 具 体 提出 以 下 指标 。 
1) 采用 速度 误差 的 平均 值 ， 反 映 速度 控制 的 准确 性 ， 车 速 表 的 最 小 分 辩 率 
为 Skmh， 驾 驶 员 对 车 速 控制 精度 不 超过 最 小 分 辩 率 ， 因 此 制定 速度 误 
差 的 平均 值 小 于 Shave 
2) 采用 速度 控制 的 均 方 根 误差 ， 反 映 速度 控制 的 稳定 性 。 瑞 虎 车 定 速 巡 航 
功能 的 速度 均 方 根 误差 在 0.54km/h， 以 这 一 指标 为 参考 。 制 定 速度 控制 
的 均 方 根 误差 为 0.5km/h。 
3) 采用 加 速 过 程 的 平均 加 速度 和 制 动 过 程 平均 减速 度 ， 反 映 速度 控制 的 快 
速 性 。 这 两 个 性 能 指标 的 主观 性 比较 强 ， 在 车 辆 正常 行驶 时 ， 不 同 的 驾 
驶 员 会 采用 不 同 的 加 速度 完成 车 辆 的 加 减速 过 程 。 而 不 同 加 速度 选择 对 
完成 路 径 跟随 任务 影响 不 大 。 目 前 控制 系统 可 以 保证 在 起 步 后 30s 内 ， 
将 速度 增加 到 60km/h; 正常 的 行 软 过 程 的 减速 ， 加 速度 约 在 -1.5m/s?。 
根据 以 上 所 述 的 设计 要 求 和 指标 , 本 文 首先 建立 车 辆 纵向 动力 学 和 运动 学 模 
型 ， 进 行车 辆 轮胎 纵向 力 和 传动 动力 学 分 析 ， 然 后 ， 在 传统 PID 控制 算法 的 基 
础 上 ， 结 合 专家 控制 系统 的 思想 设计 专家 PD 控制 方法 控制 车 辆 速度 ， 建 立 速 
度 控 制 PID 系统 的 调 参 规则 ， 从 而 解决 车 辆 传动 系统 高 度 非 线性 和 复杂 的 纵向 
干扰 条 件 所 带 来 的 控制 精度 问题 。 


2.3.3 ”横向 控制 


无 人 驾驶 车 辆 的 横向 控制 主要 研究 如 何 控制 车 辆 治 上 层 决策 系统 所 规划 的 
道路 准确 无 误 的 行驶 , 同时 要 保证 车 辆 的 行驶 的 平稳 性 和 安全 性 , 并 尽量 满足 舒 
适 性 的 要 求 。 图 2.9 描述 了 驾驶 员 对 汽车 的 操纵 过 程 ， 在 日 常 的 驾驶 行为 中 ， 熟 
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练 的 驾驶 员 一 般 以 开 环 模式 驾驶 汽车 , REPRO SRA NER A 
悉 程度 ， 知 道 怎样 的 输入 能 够 产生 期 望 的 输出 ， 这 样 车 辆 就 可 以 在 无 需 校正 的 情 
况 下 沿 期 望 的 路 径 行驶 。 而 操作 不 太 热 练 的 驾驶 员 则 恰恰 相反 , 当 行 驶 在 比较 困 
难 的 路 段 时 ， 司 机 需要 密切 注视 周围 的 环境 情况 ， 并 把 这 种 信号 视 为 反馈 ， 实 时 
地 修正 方向 盘 转 角 ， 实际 上 就 是 改变 了 控制 系统 的 输入 信号 ,系统 此 时 为 闭环 方 
式 。 
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闭环 控制 
图 2.9 人 类 对 车 辆 方向 控制 方式 示意 图 


作为 代替 人 类 驾驶 员 操作 的 无 人 驾驶 车 辆 控制 系统 , 横向 控制 的 设计 目的 是 
要 使 车 辆 具有 以 下 特点 : 

1) 准确 性 : 建立 车 辆 动力 学 和 运动 学 模型 ， 能 够 较为 准确 的 预测 车 辆 方向 

盘 的 输入 产生 输出 特性 ， 并 根据 输出 反馈 使 车 辆 能 够 沿 期 望 的 路 径 行 
w. 

2) 平稳 性 ， 车 辆 必须 具备 一 定 的 抗 干扰 能 力 ， 有 干扰 输入 时 ， 车 辆 回 到 稳 
定 状态 应 当 快 速 ， 并 保持 一 定 的 阻尼 。 

3) 适应 性 ， 车 辆 行驶 在 城市 环境 时 ， 外 部 输入 条 件 变化 范围 广泛 ， 如 路 面 
条 件 、 道 路 限制 条 件 及 天 气 条 件 等 。 控 制 系统 应 该 具有 一 定 的 自 适应 能 
力 ， 使 车 辆 在 这 些 外 部 条 件 变化 时 能 够 保持 一 致 的 行为 模式 ， 保 障 准确 
平稳 的 行驶 。 

车 辆 的 转向 运动 有 两 个 自由 度 , 横向 运动 和 横 皖 运动 , 一般 采用 横向 偏差 和 
航向 角 偏 差 评价 车 辆 对 路 径 跟随 性 能 的 准确 性 。 横 摆 角速度 ,反映 了 车 辆 横 摆 运 
动 的 速度 ， 因 此 采用 这 一 指标 评价 车 辆 的 行驶 稳定 性 。 在 设计 控制 系统 之 前 ， 对 
于 横向 控制 的 准确 性 和 稳定 性 ， 提 出 了 以 下 指标 : 

1) 参考 驾驶 员 一 般 城市 道路 沿 规定 车 道行 驶 的 要 求 ， 并 结合 本 实验 车 辆 奇 

瑞 瑞虎 车 的 几何 特性 ，1.Sm 轮 距 ， 因 此 制定 横向 偏差 沾 于 80cm。 对 于 
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3.5m 宽 的 车 道 ， 这 一 指标 可 以 保证 车 辆 在 行驶 过 程 中 不 超出 两 侧 车 道 
线 。 
2) 对 于 车 辆 的 航向 角 偏差 ,城市 道路 最 高 时 速 限制 一 般 为 80km/h， 因 此 考 
虑 极端 情况 ,假设 车 辆 时 速 为 80km/h, 车 辆 行驶 方向 与 道路 方向 存在 偏 
差 角 ， 车 辆 行驶 0.5s 后 , 若 要 求 横向 偏差 不 超出 预定 指标 ， 航 向 偏差 角 
必须 小 于 4.13"。 
3) 人 类 以 80kmyh 速度 在 直线 形 公路 行驶 时 , 横 摆 角 速度 的 峰 一 峰值 ( 相 邻 
波峰 、 波 谷 的 差 值 ) 小 于 4%/s。 参 考 这 一 指标 ， 要 求 车 辆 高 速 直 线 行驶 
时 ， 横 摄 角速度 的 峰 - 蜂 值 低 于 4°/s。 
根据 以 上 所 述 的 设计 要 求 和 指标 , 本 文 首先 建立 车 辆 横向 动力 学 和 运动 学 模 
E, 进行 车 辆 操纵 动力 学 和 轮胎 侧 向 力学 分 析 , 并 根据 人 类 驾驶 员 的 开 环 驾驶 模 
式 设计 采用 "“ 预 瞄 一 跟随 "理论 的 控制 模型 设计 车 辆 横向 开 环 控制 器 , 然后 在 传统 
PID 控制 器 的 基础 上 设计 基于 小 脑 模型 神经 网 络 与 PID 复合 的 闭环 控制 系统 。 
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城市 环境 的 道路 特点 是 功能 多 样 ， 组 成 复杂 ， 车 速 差异 大 ， 交 叉 路 口 多 , A 
此 无 人 驾驶 车 辆 在 城市 环境 中 行驶 所 面临 的 任务 较为 复杂 多 样 。 本章 结合 驾驶 员 
对 车 辆 的 控制 方式 ， 提 出 了 无 人 驾驶 车 辆 在 城市 道路 运动 控制 方法 的 设计 目标 : 
应 该 最 大 程度 的 “拟人 化 "， 能 够 像 经 验 丰富 的 驾驶 员 一 样 平稳 地 控制 转向 和 车 
速 。 本 章 第 二 节 介绍 了 "智能 先锋 "无 人 驾驶 车 辆 平台 的 体系 结构 及 感知 系统 、 决 
策 系统 、 控 制 系统 和 执行 机 构 各 子 系统 的 硬件 组 成 及 功能 。 最 后 按照 车 辆 行驶 的 
特点 将 “智能 先锋 ”的 控制 系统 分 为 横向 控制 和 纵向 控制 ， 并 根据 实际 驾驶 员 的 
轰 驶 行为 提出 了 横向 控制 和 纵向 控制 的 设计 指标 , 并 根据 指标 提出 了 控制 系统 设 
计策 略 。 
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第 三 章 “车辆 纵向 动力 学 及 纵向 控制 方法 


本 章 主要 研究 车 辆 纵向 动力 学 控制 方法 ,首先 介绍 车 辆 理想 的 动力 传动 特性 
和 制 动 力 学 特性 ， 然 后 结合 汽车 动力 学 系统 强 非 线性 的 特征 ， 提 出 了 专家 PID 
控制 算法 , 根据 实际 驾驶 员 的 驾车 经 验 建 立 专家 规则 , 解决 在 传动 系统 高 度 非 线 
性 和 复杂 的 纵向 干扰 条 件 下 的 控制 精度 的 问题 ,提高 速度 控制 的 鲁 棒 性 , 实现 无 
人 驾驶 车 辆 在 城市 道路 行驶 的 速度 控制 。 


3.1 车辆 纵向 动力 学 分 析 





图 3.1 路 面 上 车 辆 纵向 受 力 分 析 


汽车 是 通过 轮胎 与 路 面 之 间 的 作用 力 和 反作用 力 将 发 动机 输出 的 动力 转换 
为 对 车 辆 的 牵引 力 而 行驶 的 。 考虑 车 辆 在 如 图 3.1 所 示 的 路 面 上 的 运动 ， 影 响 车 
辆 的 外 部 纵向 力 包括 空气 阻力 、 重 力 、 轮 胎 纵向 力 和 滚动 阻力 。 

沿 车 辆 纵向 x 轴 方 向 力 的 平衡 方程 式 为 

mi = Fy +F, -Fm -Ry -R, —mgsin(O) on 

式 中 ，Fy、F 分 别 为 前 后 轮胎 纵向 力 ，Fow 为 纵向 空气 阻力 ，Ry、R 分 别 
为 前 后 轮 滚动 阻力 ，m 为 车 辆 质量 ; g 为 重力 加 速度 ; 9 为 车 辆 行驶 路 面 的 坡度 。 
如 果 车 辆 纵向 运动 方向 x 指向 左边 , 则 9 定义 为 顺 时 针 方向 ; 如 果 纵向 运动 方向 
x 指向 右边 ， 则 8 定义 为 递 时 针 方向 。 

1) 轮胎 纵向 力 À 
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轮胎 纵向 力 Fy 和 Fw 是 地 面 作用 于 轮胎 上 的 摩擦 力 ,其 大 小 主要 取决 于 三 方 
WAR: 滑动 素 、 法 向 载荷 、 地 面 摩擦 系数 (Canudas-de-Wit,C. et al.,2003)。 

车 车 辆 纵向 速度 为 天， 旋转 速度 为 rarov， 两 者 之 间 的 差 值 称 为 纵向 滑动 
(Pacejka, H.B.,1996)。 则 纵向 滑动 率 定义 为 : 

制 动 时 : 0 ， 62) 


owes 
加 速 时 ，“” a 63) 


假设 轮胎 接触 印迹 的 摩擦 系数 为 1， 法 向 载荷 是 常数 ， 轮 胎 滑 移 率 和 轮胎 纵 
向 力 函数 关系 曲线 如 图 所 示 。 


j F O ees 











mr os a a o o on as ox 
图 3.2 车 辆 轮胎 纵 向 济 移 率 和 轮胎 纵向 力 关系 曲线 引 自 Rajesh Rajamani(2006)) 


由 于 一 般 情况 干净 路 面 的 滑动 率 小 于 0.1， 在 纵向 滑动 率 很 小 ， 而 且 正常 驾 
了 驶 的 情况 下 ， 轮 胎 纵向 力 和 滑动 率 成 比例 : 


Fy =Cyoy G4) 
F, =C,0, G5) 
式 中 ，Cy、Ce 分 别 为 前 后 纵向 轮胎 刚度 。 


2) 空气 阻力 
作用 在 车 辆 上 的 空气 阻力 可 以 表述 为 : 
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r= SoC Ag V+ Vong P G6) 


RH, p 为 空气 密度 ， 一 般 标准 条 件 15C，101.32kPa 大 气压 力 时 空气 密度 
为 1225kglm?; Cs 为 空气 阻力 系数 , 可 以 大 臻 通过 滑行 测试 获得 . 4/ 为 迎风 面积 ， 
即 在 运动 方向 上 车 辆 的 投影 面积 。 有 为 车 辆 纵向 行驶 速度 ，Fwo 为 风速 。 

3) 轮胎 滚动 阻力 

由 于 轮胎 的 旋转 ,轮胎 和 地 面 都 在 接触 区 域 产生 形变 , 路 面 的 刚度 很 大 其 形 
变 可 以 忽略 不 计 ， 但 轮胎 是 有 弹性 的 ， 由 于 法 向 载荷 的 作用 ， 当 其 进入 接触 面 时 
会 治 着 法 向 变形 ， 消 耗 在 轮胎 变形 上 的 能 量 就 表现 为 阻碍 车 辆 前 进 的 滚动 阻力 ， 
如 图 3.3 所 示 : 








图 3.3 轮胎 印迹 的 不 对 称 法 向 力 分 布 ( 引 自 Rajesh Rajamani(2006)) 


通常 情况 下 ， 滚 动 阻力 模型 的 建立 采用 大 致 正比 于 轮胎 上 的 法 向 载荷 的 模 
型 
Ry +R, = /(Fy +F,) GD 
式 中 ，f 为 滚动 阻力 系数 ， 其 变化 范围 通常 是 001~0.04。Fy、F 为 前 后 轮 
的 法 向 载荷， 根据 车 辆 在 地 面 的 受 力 分 析 有 : 
Fy = Feels — mih = mghsin(@) + mgl, cos) 


Url, G8) 


,Tees hoe + mh + mghsin(0) + mgl, cos@) 


“1, +1, 84) 
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32 无 人 驾驶 车 辆 纵向 控制 设计 思想 


通过 上 文 对 整 车 动力 学 的 分 析 可 知 , 在 车 辆 的 纵向 速度 控制 中 , 控制 对 象 所 
处 环境 的 不 确定 因素 二 扰 较 大 ,对象 模 型 实时 变化 ， 呈 高 度 非 线性 ， 建 立 较为 准 
确 的 控制 对 象 模型 很 困难 。 而 在 实际 驾驶 员 对 车 辆 的 速度 控制 中 ， 并 不 需要 了 解 
车 辆 的 准确 模型 ， 只 要 先 有 一 定 的 驾车 经 验 ， 简 单 了 解 车 辆 的 动态 特性 ， 就 能 把 
速度 调整 在 期 望 的 设 定 值 上 。 因 此 本 文 将 在 驾驶 员 速度 控制 行为 模型 的 基础 上 研 
究 无 人 驾驶 车 辆 纵向 控制 器 的 设计 方法 。 


3.2.1 速度 控制 驾驶 员 模型 


车 速 的 升 高 或 者 降低 是 驾驶 员 踩踏 油门 踏板 或 制 动 踏板 作用 的 结果 , 不 同 的 
节气 门 开 度 和 制动器 位 置 可 以 使 车 辆 的 产生 纵向 加 速度 , 从 而 改变 车 辆 的 行驶 速 
BE. 由 于 车 辆 的 发 动机 动力 和 制 动 摩擦 力 呈现 出 非 线性 的 特性 ， 因而 车 辆 的 纵向 
控制 对 象 是 一 个 参数 变化 的 非 线性 系统 。 驾驶 员 对 车 辆 的 控制 行为 包括 对 环境 的 
认 知 理想 、 对 目标 的 识别 判断 、 对 行驶 方向 速度 的 选择 ， 以 及 通过 肢体 的 配合 对 
车 辆 所 需要 的 方向 、 油 门 、 制 动 、 换 挡 等 机 构 的 操作 控制 。 其 中 驾驶 员 对 速度 的 
控制 受到 很 多 环境 因素 影响 ， 包 括 车 辆 当时 速度 、 车 辆 的 目标 速度 、 路 面 的 混 滑 
度 、 路 面 的 高低 起 估 和 其 他 周围 环境 的 特征 等 ,驾驶 员 对 这 些 因素 的 变换 具有 很 
强 的 应 变 能 力 ， 其 控制 的 方式 也 具有 自 适应 性 、 模 糊 性 和 时 变性 。 

在 实际 的 驾车 行为 中 ， 驾 驶 员 不 太 可 能 非常 确切 地 了 解 车 辆 的 纵向 运动 特 
tt. 有 一 定 驾车 经 验 的 驾驶 员 也 不 必 非 常 了 解 车 辆 的 内 部 动力 学 特性 ,实际 驾 驶 
员 通 过 分 析 车 辆 的 速度 及 速度 的 变化 率 , 在 对 油门 和 制 动 踏板 的 响应 特性 大 致 熟 
悉 后 ， 就 能 够 根据 车 辆 的 速度 误差 来 对 车 辆 的 速度 进行 较为 准确 的 控制 。 

本 文 将 模仿 人 类 的 思维 来 求解 汽车 速度 控制 这 一 大 惯性 、 时 变性 和 强 非 线性 
系统 的 控制 问题 , 采用 基于 规则 的 专家 控制 器 , 根据 人 类 对 车 辆 驾驶 的 速度 控制 
机 理 建立 知识 库 , 根据 实验 经 验 测量 车 辆 速度 给 定 值 ， 速 度 偏差 值 ， 速 度 偏差 变 
化 的 过 程 信息 ， 并 由 知识 库 中 的 规则 推导 出 控制 量 , 实现 对 车 辆 行驶 时 纵向 速度 
的 实时 控制 。 


3.2.2 “智能 先锋 "纵向 运动 特性 分 析 


a) 加 速 性 能 

“智能 先锋 "以 奇瑞 瑞虎 为 平台 ， 其 发 动机 采用 电子 油门 。 当 驾驶 员 需 要 提 
升 车 辆 速度 时 ,改变 油门 踏板 开 度 ， 其 位 置 传感器 产生 相应 的 电压 信号 ,作用 于 
节气 门 控制 单元 , 同时 ,车 辆 中 枢 控 制 单元 提供 给 节气 门 控制 单元 车 辆 当前 状态 
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如 车 速 、 节 气门 开 度 ， 并 且 计 算 车 辆 参数 是 否 满足 控制 函数 ， 对 节气 门 开 度 进行 
补偿 ， 获 得 节气 门 的 最 佳 开 度 ， 最 后 ， 发 送 电压 信号 至 电机 驱动 模块 ， 从 而 控制 
车 辆 速度 。“ 智 能 先锋 "通过 直接 控制 油门 电压 ， 实 现 速度 的 自动 控制 ， 电 压 信号 
输入 范围 为 0.37~1.6V， 实 验 时 取 电 压 值 0.5~1.4V。 对 应 不 同 的 油门 电压 值 ， 车 
辆 速度 (m/s) 随 油门 电压 响应 曲线 如 图 3.4 所 示 ， 其 采样 时 间 为 50ms， 可 见 在 给 
定 油门 开 度 的 情况 下 速度 时 非 线性 变化 。 图 3.5 显示 了 车 辆 加 速度 (m/s ) 随 油门 
电压 响应 曲线 变化 的 情况 , 由 图 可 见 在 给 定 油门 开 度 的 情况 下 加 速度 是 随 速 度 的 
增 大 而 减 小 的 ， 并且 受 外 界 环境 干扰 较 大 ， 因 此 难以 对 其 动态 特性 建立 精确 的 仿 
真 模型 。 
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图 3.4 车 辆 速度 随 油门 电压 响应 曲线 
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图 3.5 车 辆 加 速度 随 油门 电压 响应 曲线 
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(2) 制 动 性 能 

“智能 先锋 "的 制 动 装置 包括 电机 、 减 速 器 、 编 码 器 和 传 感 机 构 ， 减 速 器 为 蜗 
轮 蜗 杆 减速 器 , 输入 端 连 着 电机 ， 电 机 后 端 输出 轴 上 连接 编码 器 ,减速 器 输出 轴 
连接 钢 线 线 轮 , 利用 其 拉动 原 车 辆 制 动 踏板 。 通 过 控制 编码 器 的 编码 数 给 出 制 动 
指令 , 电机 接受 指令 开始 运转 ， 连 接 的 钢 线 开始 拉 下 制 动 踏板 , 实现 无 人 驾驶 车 
辆 的 自动 制 动 。 当 通过 编码 数 给 出 松 开 制 动 的 指令 后 ,电机 反 转 ， 车 辆 的 制 动 路 
板 本 身 可 自动 回 位 。“ 智 能 先锋 "通过 制 动 电机 实现 自动 制 动 ,其 电机 的 工作 范围 
为 -25500~-48000。 对 应 不 同 的 制 动 电机 编码 值 ， 实 验 取 电压 值 -36000~-48000， 
实验 对 20km/h 行驶 的 车 辆 施加 不 同 幅度 的 制 动 ， 车 辆 速度 (m/s) 随 制 动 幅度 的 响 
应 曲线 如 图 3.6 所 示 ， 其 采样 时 间 为 50ms。 图 3.7 显示 了 其 加 速度 对 应 于 不 同 制 
动 幅度 的 响应 曲线 。 由 图 可 见 ， 在 给 定制 动 幅度 作用 下 ， 速 度 基本 时 线性 减 小 ， 
其 加 速度 近似 为 一 个 相应 的 稳 坟 值 。 












































图 3.7 车 辆 加 速度 苦 制 动 幅度 响应 曲线 
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33 ”建立 基于 规则 的 专家 PD 速度 控制 系统 


3.3.1 专家 控制 理论 


自动 控制 系统 理论 中 存在 大 量 的 难以 用 规定 数值 表示 的 逻辑 概念, 因为 在 普 
通 的 工业 控制 过 程 中 ,其 控制 对 象 和 所 处 环境 变化 较为 复杂 , 皇 现 出 非 线性 的 特 
点 。 因 此 ， 需 要 采用 人 们 在 长 期 实践 过 程 中 积累 的 各 种 经 验 知识 ， 这 种 知识 适用 
于 符号 形式 表述 , 专家 系统 理论 就 为 这 些 人 类 累积 的 经 验 提供 了 有 效 的 表示 和 处 
理 方法 ， 它 也 是 人 工 智能 中 重要 的 应 用 领域 
专家 系统 理论 于 1980 年 兴起 ， 之 后 许多 从 事 研究 自动 控制 科学 的 学 者 也 开 
始 在 自动 控制 领域 的 研究 与 应 用 之 中 融入 专家 系统 的 思想 ,专家 系统 是 一 种 建立 
在 专家 知识 表示 之 上 的 系统 , 它 通 过 知识 推理 达到 系统 的 任务 指标 , 在 解决 各 种 
结构 化 程度 不 高 的 问题 中 ,作用 很 大 ,特别 是 知识 内 容 的 描述 具有 不 定量 、 模 糊 
等 特点 ,专家 系统 理论 为 解决 经 典 控制 方法 过 于 依赖 数字 形式 表达 的 局 限 性 提供 
了 新 的 思路 , 专家 控制 系统 便 成 为 了 专家 系统 理论 与 经 典 自动 控制 理论 相 结合 的 
产物 。 
1. 专 家 控制 系统 定义 和 特点 
人 工 智能 的 思想 ， 尤 其 是 专家 系统 理论 推动 了 控制 学 科 的 发 展 。1983 F, 
瑞典 学 者 Astorm KJ.(1986) 提出 了 专家 控制 的 概念 ， 他 将 专家 系统 的 思想 引入 
自动 控制 领域 ， 对 专家 控制 进行 了 比较 深入 的 阐述 ， 并 开展 了 一 系列 系统 实验 。 
经 过 控制 界 专家 学 者 近 20 多 年 的 研究 工作 ， 专 家 控制 系统 在 深度 和 广度 上 都 得 
到 了 一 定 的 发 展 。 
定义 : 对 人 类 专家 的 经 验 进行 总 结 , 建造 出 一 种 基于 专家 控制 参数 的 控制 系 
统 ， 并 且 符合 专家 系统 的 概念 要 求 ， 这 种 控制 系统 称 为 专家 控制 系统 。 
专家 控制 系统 的 任务 要 求 是 在 不 可 测 环境 条 件 下 , 利用 专家 的 经 验 , 结合 现 
有 控制 理论 与 技术 ， 对 系统 进行 控制 ， 达 到 理想 的 效果 。 
专家 控制 系统 除了 具有 专家 系统 本 身 所 具有 的 特征 以 外 ， 还 拥有 以 下 特征 : 
1) 具有 基于 时 间 序 列 的 知识 表示 及 推理 方法 。 一 般 的 专家 系统 的 知识 表示 
往往 是 和 时 间 序 列 无 直接 关系 的 ， 但 对 于 专家 控制 系统 则 要 求 在 线 的 采 
集 数 据 ， 并 准确 地 表示 控制 系统 的 实时 特性 ， 从 而 进行 数据 时 序 推理 、 
及 时 决策 和 控制 。 
2) 具有 很 强 的 实时 性 。 专 家 控制 系统 的 实时 性 非常 重要 ， 要 求 具备 以 下 几 
Ai: 控制 策略 、 数 据 管理 、 经 验 表 示 的 灵活 性 和 模式 匹配 等 方面 需要 具 
备 灵活 性 推理 能 力 强 ， 同 时 要 求 推理 机 构 应 尽 可 能 简单 ， 信 息 采集 及 
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处 理 能 力 强 运行 可 靠 性 高 ， 专 家 控制 系统 对 被 控 过 程 或 对 象 进 行 实时 控 
制 是 ， 必 须 在 每 个 采样 周期 内 都 给 出 控制 信号 ， 因 此 对 专家 系统 运算 速 
度 的 要 求 也 很 高 。 
3) 接受 来 自 操作 者 的 交互 指令 序列 ， 并 能 在 线 修正 序列 式 基本 控制 知识 。 
有 ”决策 和 控制 能 力 强 。 能 够 处 理 随机 性 、 不 完整 性 和 不 准确 性 任意 时 变 非 
线性 系统 的 控制 问题 ， 该 类 常规 控制 方法 难以 解决 的 问题 。 
5) 具备 与 计算 机 控制 等 应 用 系统 的 通用 性 。 对 于 专家 控制 器 ， 应 该 能 够 方 
便 地 嵌入 到 计算 机 控制 系统 中 ， 对 于 专家 控制 系统 要 能 与 SCADA 进行 
灵活 地 连接 。 
2. 专 家 控制 系统 的 基本 原理 
1) 专家 控制 的 最 终 目标 是 应 用 于 实际 生产 生活 当中 ; 
2) 当 外 部 环境 复杂 多 变 时 ， 具 有 很 强 的 抗 干扰 性 ， 同 时 ， 不 受 控制 对 象 时 
变 、 线 性 程度 较 低 的 影响 ; 
3) 专家 控制 的 运行 对 对 象 的 先 验 知识 依赖 较 少 ; 
4) 具有 在 线 学 习 功 能 ， 能 够 随 着 系统 的 运行 ， 补 充 知识 库 、 改 进 控制 效果 ; 
5) 专家 控制 系统 应 当 接 受用 户 对 控制 效果 定性 的 描述 , 例如 “控制 周期 尽 可 
能 小 "、“ 控 制 效 果 尽 可 能 好 "等; 
O 具有 故障 自 诊断 功能 ， 当 控制 环节 中 的 传感器 或 者 机 构 出 现 错误 时 ， 控 
制 系统 可 以 得 到 反馈 ， 在 可 能 修复 的 时 候 ， 应 主动 修复 ; 
7) 应 具有 合理 的 人 机 交互 界面 ， 用 户 可 以 自由 地 得 到 控制 系统 内 部 的 执行 
信息 ， 例 如 传感器 的 反馈 信息 ， 控 制 系统 的 动 、 静 态 特性 等 等 。 
一 般 来 说 , 传统 控制 理论 和 技术 的 成 就 及 特长 在 于 它 针对 精确 描述 的 解析 模 
型 进行 精确 的 数值 求解 , 即 它 的 着 眼 点 主要 限于 设计 和 实现 控制 系统 的 各 种 核心 
算法 。 而 专家 控制 的 基本 原理 是 面 对 一 些 启发 式 运 辑 ， 试 图 采用 形式 化 的 方法 ， 
将 这 些 启发 式 远 辑 组 织 起 来 ， 进行 一 般 的 处 理 ， 从 它们 与 核心 算法 的 结合 上 使 传 
统 控制 表现 出 较 好 的 智能 性 。 与 经 典 控制 理论 不 同 ， 专 家 控制 的 作用 和 特点 在 于 
依照 完整 描述 的 受 控 过 程 知识 和 经 验 , 经 过 推理 决策 , 以 获得 更 好 的 控制 性 能 ( 孙 
SAT, 1997). 
由 于 专家 控制 系统 被 控 对 象 和 控制 器 的 模型 不 局 限于 单纯 的 解析 模型 , 它 有 
多 样 化 的 表现 形式 ,如 知识 模型 、 物 理 模型 、 模 糊 模 型 、 神 经 网 络 模型 和 基于 高 
散 事件 的 模型 等 。 由 于 专家 控制 器 模型 的 多 样 性 ， 其 实现 方法 多 种 多 样 。 大 体 上 
可 分 为 两 类 : 一 类 是 具有 简单 的 专家 控制 结构 ,简洁 的 知识 库 和 简单 合理 的 推理 
结构 ; 另 一 类 是 建立 在 现 有 控制 算法 上 的 专家 控制 系统 ,在线 调节 控制 器 , 提高 
其 智能 性 。 第 二 种 虽然 不 如 第 一 种 完善 ， 但 其 实时 性 较 高 ， 控 制 效果 良好 ， 前 景 
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ria. 
3. 专 家 控制 系统 的 基本 结构 
由 于 对 实际 应 用 中 对 专家 控制 系统 的 控制 要 求 不 同 ， 所 选择 表现 形式 不 同 ， 
因此 专家 控制 系统 的 结构 也 不 尽 相同 。 但 是 , 几乎 所 有 的 专家 控制 系统 都 具有 这 
样 的 基本 组 成 : 知识 库 (Knowledge Base)、 推 理 机 (Inference Engine)、 综 合 数据 库 
(Global Database), 、 解 释 接口 (Explanation Interface) 和 知识 获取 (Knowledge 
Acquisition) 等 。 专 家 控制 系统 的 基本 结构 如 图 3.8 所 示 。 
用 户 接口 




















推理 机 领域 数据 


了 一 
二 Pie 过 程 f fee 


图 3.8 专家 控制 系统 典型 结构 



























































专家 控制 系统 的 基本 结构 具有 以 下 特点 ( 王 顺 网 ,等 ，2005): 

(0 专家 控制 的 结构 主要 包括 数值 计算 方法 和 知识 库 子 系统 。 其 中 前 者 包括 
控制 、 辩 识 和 监控 三 部 分 算法 , 它们 的 处 理 过 程 面向 定量 的 知识 , 对 其 进行 计算 ; 
而 后 者 面向 的 是 抽象 的 知识 , 运用 符号 形式 进行 计算 。 这 两 大 部 分 体现 了 知识 的 
不 同属 性 ,同时 也 符合 智能 控制 过 程 中 的 分 层 原则 ， 呈现 出 递 阶 控制 的 特点 。 不 
同 的 是 ,在 编码 上 ,数值 计算 方法 可 以 运用 常规 编程 的 方式 ， 而 知识 库 子 系统 则 
必须 符合 专家 系统 的 编码 规范 ; 计算 速度 上 ， 前 者 快速 、 准 确 ， 而 推理 过 程 则 较 
缓慢 。 

(2) 三 部 分 过 程 并 行 处 理 。 三 种 过 程 -数值 计算 方法 、 知 识 库 系统 、 人 机 通讯 ， 
在 实际 的 计算 机 应 用 中 是 并 行 处 理 的 , 数值 计算 方法 的 优先 级 最 高 。 人 机 通讯 与 
知识 库 系统 是 不 经 中 转 地 通讯 , 而 数值 计算 方法 则 要 通过 一 定 的 中 转 .数值 计算 
方法 可 以 按照 其 周期 终止 人 机 通讯 ,专家 控制 系统 的 这 种 并 行 处 理 机 制 是 确保 系 
统 及 时 性 的 重要 措施 ， 其 过 程 结合 相当 紧密 。 
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332 专家 PID 控制 原理 


常规 PID 控制 算法 可 以 表示 为 
u(t)=K, e+ [eoar SSO. de), 
=K,e(t)+K, [ear+K, 


式 中 ，Ti，T2 分 别 为 控制 器 积分 时 间 常数 和 微分 时 间 党 数 : K K Ki 
制 器 的 比例 系数 、 积 分 系数 和 微分 系数 

当 采 用 增 量 式 PID 控制 方式 时 ， 其 算法 的 数学 逆 失 表达 式 为 

Au, =K,Ae, + Ke, +K; (Ae, — Aei) 

Rp, MaMa tA, Be, 56-8, Bey = Aen hens, 

常规 PID 控制 一 般 根据 控制 过 程 的 动态 及 稳 志 特性 来 整定 控制 器 的 各 参数 ， 
但 当 控制 对 象 随 时 间 空间 发 生变 化 ,或 被 干扰 影响 时 ，PID 控制 器 不 容易 达到 原 
先 预 期 的 最 佳 的 设 定 信 跟 踪 效 果 和 于 扰 量 抑制 ， 甚至 容易 因此 产生 振荡 。 HTA 
RHM PID 控制 在 这 一 方面 的 缺陷 ， 结 合 专家 控制 系统 思想 设计 专家 PID 控制 
器 是 一 种 有 效 的 方法 ( 王 威 .等 , 2008)。 

专家 控制 系统 是 在 专家 系统 的 基础 上 ， 运 用 其 专业 内 已 有 知识 ,学 习 领 域 专 
家 的 控制 方法 与 过 程 进行 规则 推理 的 自控 系统 ( 药 自 兴 , 2004). 将 专家 控制 与 PID 
控制 器 相 结合 便 构成 专家 PID 控制 器 。 

对 于 一 般 的 二 阶 系统 其 单位 阶 中 响应 的 误差 曲线 如 图 3.9 所 示 。 


ane 


图 3.9 典型 二 阶 系统 单位 阶 跃 响 应 误差 曲线 


系统 的 设计 方法 是 根据 误差 、 误 差 变化 的 特征 ， 设 计 专家 PD 控制 器 , 其 
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PID 参数 的 调整 规则 列举 为 以 下 几 条 : 

(1) 当 le(9PM; 时 ， 表 示 此 时 系统 输出 误差 很 大 ， 应 实施 开 环 控制 ， 控 制 
器 的 控制 量 应 按 所 允许 的 最 值 控制 ， 系 统 可 以 快速 调整 误差 ， 便 于 其 尽快 减 小 。 

(2) 4 ese) 时 ， 说 明 误差 在 向 远离 平衡 点 的 方向 变化 ， 此 时 若 
le()PEM2， 由 控制 器 输出 较 大 的 控制 作用 或 开 环 作用 ， 若 le(D|<M2， 由 控制 器 则 
逐渐 减 小 控制 作用 。 

(3) 当 e(04e()<04e(04e(1-1)>0 È e(O 时 ， 说 明 误 差 在 向 平衡 点 的 方向 
变化 ， 或 在 平衡 点 附近 摆动 ， 或 已 达到 稳定 点 ， 这 个 时 候 使 系统 控制 量 恒定 。 

(4) 4 e(bde(D<0de(f)4e(t-1)<0 时 ,表明 系统 偏差 极 大 或 极 小 。 若 |e(D|>M2， 
则 由 控制 器 输出 较 大 的 控制 作用 或 开 环 作用 ; 若 le()<M2， 则 逐渐 减 小 控制 作用 。 

(5) Helje 时 ， 此 时 控制 误差 接近 0， 应 主要 有 积分 环节 作用 以 减 小 稳 
BRE. 

上 述 参数 中 ，M,，M; 为 两 种 状态 的 误差 界限 ， 其 中 Mj>M;， 为 足够 小 的 
ERM. 
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根据 以 上 原理 ， 设 计 一 种 专家 PID 控制 器 用 来 模拟 人 类 的 行为 实现 车 辆 的 
自动 驾驶 ,控制 器 的 设计 目的 是 为 了 控制 车 辆 的 油门 和 制 动 ， 以 获得 舒适 平稳 的 
驾驶 行为 来 保持 恒定 的 速度 或 快速 跟踪 期 望 速度 的 变化 。 为 此 ,被 用 作 控 制 器 的 
输入 的 两 个 参数 为 : 

(1) 速度 误差 :车 辆 当前 速度 值 与 设 定 的 期 望 值 之 差 。 
(2) 加速度， 车 辆 当前 速度 的 时 间 导 数 。 

其 中 ， 期 望 速度 值 由 决策 系统 提供 ， 车 辆 当前 的 速度 和 加 速度 可 以 通过 
GPS/IMU 信号 系统 获得 。 

控制 器 将 提供 两 个 输出 信号 ， 一 个 用 于 油门 ， 另 一 个 用 于 制 动 。 根 据 "智能 
先锋 "的 执行 机 构 特点 ， 用 于 油门 的 输出 量 是 直接 施加 在 电子 油门 的 电压 值 ， 用 
于 制 动 的 输出 量 是 控制 电机 编码 器 的 编码 值 。 


3.4.1 油门 控制 


油门 控制 的 主要 目的 是 使 车 辆 跟踪 期 望 车 速 行驶 ， 即 当 车 速 低 于 期 望 速度 
时 ， 控 制 器 将 提供 合适 的 加 速度 ， 当 速度 达到 期 望 速度 时 ， 控 制 器 将 提供 稳定 的 
动力 维持 当前 速度 。 其 结构 如 图 3.10 所 示 ， 设 计 具 体 专家 规则 如 下 : 
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GPS 速度 信号 
图 3.10 专家 PID 控制 结构 图 











专家 规则 1 MAHAM R PD 控制 参数 的 修正 系数 Kn。 

根据 无 人 驾驶 车 辆 的 不 同行 驶 状态 ,往往 需要 调整 在 不 同 给 定 速度 下 的 PID 
参数 。 根 据 前 面 对 “ 智 能 先锋 "纵向 动力 特性 的 分 析 ， 节 气门 开 度 与 加 速度 的 关系 
受 车 辆 行驶 速度 的 影响 ， 不 同 的 设 定 速度 ， 其 动态 特性 不 同 ， 需 要 不 同 的 PD 
参数 才能 达到 最 优 的 控制 效果 。 如果 给 定 速度 较 低 , 则 需要 发 动机 提供 的 输出 动 


力 较 小 ， 所 以 油门 的 给 定 电压 值 较 小 ， 具 体 修正 系数 参见 表 3.1。 
表 3.1 期望 输入 值 Ri Xt PID 控制 参数 的 修正 系数 Kx 












p |0 
Ka |°” 

















专家 规则 2 速度 误差 w 对 PID 控制 参数 的 修正 系数 Kue 

根据 控制 精度 的 要 求 ， 把 速度 误差 ea 分 为 三 种 情况 分 别 控制 :， +5km/h 为 理 
想 过 程 区 域 ， 该 区 域 以 稳定 运行 为 主 ,可 减少 油门 电压 信号 变化 ,修正 的 系数 较 
小 。+5km/h~+20kmh 为 加 速 或 减速 过 程 ， 在 该 误差 区 间 内 控制 器 应 增 大 修正 系 
数 ， 加 快 响应 速度 。 此 时 应 主要 增 大 K 的 修正 系数 ， 使 误差 迅速 减 小 。 
#20km/h~+30km/h 是 误差 较 大 的 区 间 , 系统 处 于 该 过 程 过 大 的 误差 可 能 会 产生 较 
大 的 输入 量 ， 此 时 为 了 不 出 现 油门 过 度 调整 而 使 车 体 产生 较 大 的 浆 动 ， 需要 降低 
PID 各 参数 ， 尤 其 是 减 小 Ki， 使 车 辆 能 够 平稳 的 加 减速 度 。 具 体 修正 系数 参见 表 
3.2。 
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表 3.2 速度 误差 所 对 PD 控制 参数 的 修正 系数 Ka 









































leil Okmh |2kmh |4kmh |6kmh |8kmh |10kmh |12kmh |14kmh 
0.65 0.75 087 10 11 12 132 15 
EA t 
r. 0 o 0 0.75 io 10 11 11 
Kea _|S% 08 0.85 09 0.95 10 125 1.25 
lel l6kmh | 18 kmh |20kmh | 22kmh | 24 km | 26kmh | 28 kmh | 30 kmh 
-二 二 
K, 15 1.25 10 085 08 0.75 07 06 
K, 09 oss [ors «| 07 06 oss [os 04 
ia 
A 10 “| 09 08s 0 0.75 07 
Kia |" 09 s fe 











专家 规则 3 速度 误差 变化 率 4e; 对 PID 控制 参数 的 修正 系数 Ksw。 
用 Hel 表 示 速 度 误差 的 变化 率 ， 若 Mei 过 大 系统 可 能 会 引起 振荡， 此 时 应 减 


小 PID 的 修正 系数 ， 抑 制 系统 的 振荡 过 程 。 具 体 修正 
RII 速度 误差 变化 率 ey 对 PID 控制 参数 的 修正 系数 Kae 


系数 参见 表 3.3。 
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专家 规则 4 控制 值 u HRA. 
如 果 PID 控制 量 uw 是 发 动机 油门 电压 值 ， 则 应 根据 发 动机 的 特性 进行 限 幅 ， 
最 大 值 和 最 小 值 可 以 根据 经 验 输 入 计算 机 ， 也 可 以 由 计算 机 自动 整定 。 最 大 值 不 
能 使 发 动机 超过 最 大 输出 功率 ,最 小 值 是 随 着 速度 误差 而 变化 的 ， 即 根据 速度 误 
差 要 乘 上 相应 的 修正 系数 。 具 体 修正 系数 参见 表 3.4。 




















KIA u HR 
a Okwh | 2kmh [am [km | sa | iokmh [12mh | 14kmm 
Ka | oss |os 08 ors (o7 0.65 
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根据 上 述 专家 规则 ， 可 以 通过 查 表 计 算 ， 在 上 次 PID 参数 的 基础 上 得 到 本 


次 的 PID 参数 。 满 足 公式 : 
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nl eK, Ku, 

Ky = Kya *Ky Ky Ku, 

Ka =Kae Kne Ko Kay 

Au, = Ky Ae, + Kye, + Kalde, 一 Ac) 


Upa SU =u, +AU; S thay 


3.4.2 RS 


制 动 控制 的 主要 目的 是 使 车 辆 减速 和 停车 , 即 当 车 速 高 于 期 望 速度 时 , 控制 
器 将 提供 合适 的 加 速度 ， 在 减速 时 ， 为 了 避免 减速 危险 ， 不 宣 输 出 过 大 制 动 ， 但 
发 生 紧急 停车 的 状况 时 ,控制 器 应 提供 最 大 的 制 动 力 。 由 于 车 辆 速度 的 跟踪 精度 
是 由 油门 控制 保持 的 , 只 有 当 车 辆 当前 速度 高 于 期 望 速度 时 才 采 用 制 动 控制 ， 实 
施 控制 主要 以 开 环 模式 为 主 ， 设 计 具 体 专家 规则 如 下 : 
1) 当 e(<0 时 ， 加 速 过 程 ，wwveu=0; 
2) 当 |e(DIK5 时 ， 车 速 保 持 过 程 ，wprate=0; 
3) 当 e(b>5， 并 且 depo 时 ， 车 速 过 高 并 且 加 速度 为 正如 下 坡 行驶 )， 
需要 提供 较 大 的 制 动 力 ，uprete=-44000; 
4) Heks, 并 且 Aek 时 ,车速 过 高 并 且 车 辆 正在 减速 ,需要 提供 较 小 
的 制 动 力 ，wprats =-40000; 
5) 当 e( 昌 很 大 ， 并 且 期 望 车 速 为 0 时， 表示 车 辆 需要 紧急 停车 ， 此 时 应 提 
供 最 大 制 动 力 ，xaraue =-48000。 


3.5 ”速度 控制 测试 实验 


为 了 验证 控制 器 的 效果 ， 本 文 设计 了 若干 实验 。 图 3.11 显示 实验 场地 的 航 
拍 图 与 实景 图 , 它 的 路 面包 含 一 些 起 伏 , 用 来 测试 在 不 同 环境 条 件 下 控制 器 的 准 
确 性 。 这些 实 验 的 目的 主要 是 测试 控制 器 保持 恒定 速度 的 性 能 ， 以 及 期 望 速 度 改 
变 时 的 跟踪 能 力 。 在 实验 中 , 汽车 转向 是 手动 控制 , 油门 和 制 动 踏板 为 自动 控制 ， 
实验 分 析 了 车 辆 在 达到 和 保持 目标 速度 过 程 中 的 速度 及 误差 反馈 数值 , 并 将 跟踪 
效果 与 人 驾驶 车 辆 的 速度 控制 行为 进行 比较 。 
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图 3.11 速度 测试 实验 场景 


(1) 轰 驶 员 驾驶 车 辆 速度 控制 和 车 载 定 速 巡 航 系统 的 速度 控制 效果 

为 了 验证 本 文 所 设计 的 速度 控制 系统 的 性 能 ， 首 先 通过 GPS 采集 了 人 驾驶 
车 辆 时 ， 以 及 车 辆 配置 的 定 速 巡 航 系统 对 车 辆 速度 控制 的 效果 ， 实 验 设 定 两 种 模 
式 下 分 别 跟踪 40km/h 和 SOkmh 的 速度 ， 结 果 显示 在 以 下 图 中 : 图 3.12 记录 了 
轰 驶 员 跟踪 40km/h 时 对 车 辆 的 速度 控制 过 程 ， 由 图 可 见地 面 的 上 下 坡度 对 速度 
控制 的 影响 较 大 ， 误 差 范围 为 -5-lkm/h。 图 3.13 记录 了 车 载 定 速 巡 航 系统 跟踪 
40km/h 时 对 车 辆 的 速度 控制 过 程 ， 由 图 可 见 其 跟踪 效果 同样 受 路 面 的 上 下 坡度 
影响 ， 并 且 在 上 坡 和 下 坡 路 段 存在 不 同 的 稳 坟 误差 ， 其 误差 范围 为 -2-0.5kmh。 
图 3.14 记录 了 驾驶 员 跟 踪 80km/h 时 对 车 辆 的 速度 控制 过 程 , 由 图 可 见 驾 驶 员 驾 
驶 车 辆 时 ， 对 速度 的 控制 是 不 断 调整 的 ， 其 动态 误差 较 大 ， 误 差 范围 为 
-6~2.5km/h。 图 3.15 记录 了 车 载 定 速 巡航 系统 跟踪 80kmh 时 对 车 辆 的 速度 控制 
过 程 ， 由 图 可 见 其 跟踪 效果 受 路 面 的 上 下 坡度 影响 ， 其 误差 范围 为 -2.5~lkmh。 


aL 
sise 000000 


第 三 章 车 辆 纵向 动力 学 及 纵向 控制 方法 














eh 

o 50 10 150 20 250 30 30 40 
time(0.18) 

图 3.12 人 类 驾驶 员 40km/b 速度 控制 速度 曲线 
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o 10 20 30 40 50 60 70 80 
time(0.18) 
图 3.13 车 载 定 速 巡 航 40km/h 速度 控制 速度 曲线 
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图 3.14 人 类 驾驶 员 80km/h 速度 控制 速度 曲线 
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图 3.15 FREBOM 80kmhh 速度 控制 速度 曲线 
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(2) 40km/h 速度 保持 实验 

实验 结果 显示 在 以 下 图 中 : 图 3.16 CRTMSRRRED 40mh 后 , 车辆 
速度 变化 的 过 程 , 由 图 看 出 车 辆 在 起 步 后 是 一 个 缓慢 加 速 的 过 程 , 这 一 过 程 也 符 
合 人 类 驾驶 员 的 起 步 时 的 行为 。 在 第 一 个 10s 之 内 ， 车 辆 平缓 加 速 ， 在 10s-20s 
时 车 辆 进入 快速 加 速 的 过 程 ， 经 过 20s 的 时 间 ， 车 辆 速度 达到 期 望 速度 ， 并 平稳 
地 保持 该 速度 行驶 。 由 图 看 出 上 下 坡 的 路 段 对 车 辆 行驶 速度 没有 影响 。 图 3.17 
记录 了 车 辆 速度 达到 期 望 速度 和 保持 期 望 速度 过 程 中 的 速度 误差 , 其 误差 范围 为 
-0.4-02kmhh。 图 3.18 和 图 3.19 分 别 记录 了 行驶 过 程 中 控制 器 的 输出 和 车 辆 的 加 
速度 ， 其 中 最 大 加 速度 为 0.8m/s:， 符 合 车 辆 行驶 的 舒适 性 和 安全 性 要 求 。 
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图 3.16 专家 PID 控制 器 40km/b 速度 控制 速度 曲线 
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图 3.17 40km/h 速度 跟踪 误差 曲线 
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图 3.18 40kmih 车 辆 行驶 加 速度 曲线 
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图 3.19 40kmhmh 控制 器 输出 油门 值 


(3) 80kmh 速度 保持 实验 

实验 结果 显示 在 以 下 图 中 : 图 3.20 记录 了 期 望 速度 设 定 为 80km/h 后 ， 车 辆 
速度 变化 的 过 程 ， 由 图 看 出 车 辆 在 起 步 后 是 一 个 缓慢 加 速 的 过 程 , 这 一 过 程 符合 
人 类 驾驶 员 的 起 步 时 的 行为 。 在 第 一 个 10s 之 内 ， 车 辆 平缓 加 速 ， 在 10s-40s 时 
车 辆 进入 快速 加 速 的 过 程 ， 经 过 40s 的 时 间 ， 车 辆 速度 达到 期 望 速度 ， 并 平稳 的 
保持 该 速度 行驶 。 由 图 看 出 上 下 坡 的 路 段 对 车 辆 行驶 速度 没有 影响 。 图 3.21 记 
录 了 车 辆 速度 达到 期 望 速度 和 保持 期 望 速度 过 程 中 的 速度 误差 ， 其 误差 范围 为 
-0.6-0.2kmh. 图 3.22 记录 了 车 辆 的 加 速度 ， 其 中 最 大 加 速度 为 08m/sz， 符 合 车 


辆 行驶 的 舒适 性 和 安全 性 要 求 。 
表 3. RRA, ME MGM KG ATR PID 控制 的 纵向 控制 器 达到 期 望 速度 后 的 速度 跟 
踪 误 差 对 比 














[BRA 定 速 巡 航 系统 。 专家 PID 控 制 器 
40km/h 速 度 误差 “| -5~lkm/h -2-0.5kmh | -0.4~0.2km/h 
40km/h 速 度 误差 “| -6~2.5km/h -2.5~1kmh | -0.6-0.2kmmh 





表 3.5 列 出 了 以 上 两 组 实验 要 求 期 望 速度 下 ， 驾 驶 员 、 车 载 定 速 巡 航 系统 和 
本 文 所 设计 的 基于 专家 PID 控制 的 纵向 控制 器 在 达到 期 望 速度 之 后 的 速度 跟踪 
误差 。 结 果 反映 出 ， 本 文 所 设计 的 控制 器 对 于 速度 的 跟踪 性 能 优 于 驾驶 员 、 车 载 
定 速 巡 圾 系统 。 

















图 320 专家 PID 控制 器 80km/h 速度 控制 速度 曲线 
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图 321 80kmhh 连 度 跟踪 误差 曲线 
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图 3.22 8Okmhh 速度 跟踪 加 速度 变化 曲线 


(4) 跟踪 变化 的 期 望 速度 
图 3.23 和 3.24 记录 了 期 望 速度 发 生 改 变 时 的 车 辆 速度 跟踪 情况 , 由 图 看 出 ， 
当期 望 速度 发 生 改变 时 ,控制 器 控制 车 辆 的 速度 进行 平滑 地 调整 , 达到 期 望 速度 
后 能 够 稳定 的 保持 当前 速度 。 
0 


speed(kmh) 
è 2 
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tienof0.15) 
图 3.23 期 望 速度 改变 的 速度 跟踪 结果 
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图 3.24 期 望 速度 改变 的 速度 妹 踪 结 果 


700 


由 实验 结果 可 以 得 出 ， 专 家 PID 控制 方法 使 得 车 辆 的 速度 控制 过 程 更 类 似 
于 人 类 驾驶 员 的 行为 模式 。 专 家 PID 控制 根据 实际 驾驶 员 速度 控制 的 特点 的 经 
验 建立 控制 规则 和 调 参 规则 ， 具 有 很 强 的 针对 性 ， 因 此 控制 效果 要 比 常规 PID 
控制 效果 好 得 多 。 专 家 PID 控制 不 要 求 控制 对 象 数学 模型 的 精确 性 。 从 以 上 的 
实验 结果 看 ， 系 统 在 采用 专家 PD 控制 方法 后 具有 较 好 的 稳 态 、 动 态 特性 ， 对 
于 环境 和 被 控 对 象 的 变化 有 较 强 的 适应 能 力 ， 同 时 符合 车 辆 行驶 的 舒适 性 。 


36 本 章 小 结 


本 章 首先 进行 了 车 辆 纵向 动力 学 分 析 , 并 讨论 了 实际 驾驶 员 驾车 时 对 速度 控 
制 的 行为 模式 , 然后 由 实验 数据 分 析 了 “智能 先锋 "无 人 车 的 动力 传动 特性 和 制 动 
力学 特性 ,车 辆 纵向 动力 学 系统 的 强 非 线性 和 易 受 环 境 因素 影响 的 特点 , 结合 了 
“智能 先锋 "无 人 车 的 动力 特性 和 驾驶 员 驾 车 时 速度 控制 的 经 验 ， 制 定 了 专家 规 
则 ， 提 出 了 专家 PID 控制 的 方法 ， 根 据 驾驶 员 的 经 验 建立 PID 参数 的 调整 规则 ， 
从 而 避免 了 对 被 控 对 象 模型 精确 建 模 的 困难 , 同时 提高 了 速度 控制 的 鲁 棒 性 。 最 
后 由 实验 验证 了 该 控制 算法 的 速度 控制 精度 , 符合 系统 设计 的 要 求 , 并 且 对 于 环 
境 和 被 控 对 象 的 变化 有 较 强 的 适应 能 力 。 
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第 四 章 “车辆 横向 动力 学 及 横向 控制 方法 


本 章 首先 介绍 一 个 最 基本 的 简化 两 自由 度 车 辆 动力 学 模型 , 仅 考虑 车 辆 的 模 
择 及 横向 运动 ,在 两 自由 度 基本 动力 学 模型 基础 上 , 将 无 人 车 辆 轨迹 跟踪 的 控制 
问题 描述 为 状态 空间 的 形式 ,接着 为 了 控制 轨迹 跟踪 的 实时 横向 误差 , 结合 经 典 
PID 控制 方法 ， 在 “ 预 风 一 跟随 "理论 的 控制 模型 的 基础 上 设计 了 一 种 小 脑 模型 神 
经 网 络 与 PID 复合 的 横向 控制 器 ， 该 控制 器 可 以 对 不 同 的 环境 信息 和 不 同 驾驶 
模式 自动 进行 系统 参数 优化 , 从 而 使 无 人 车 能 够 灵活 的 在 各 种 道路 环境 中 实现 稳 
定 、 准 确 的 道路 跟踪 行驶 。 最 后 对 以 上 控制 方法 的 仿真 结果 进行 简单 介绍 。 


4.1 车辆 横向 控制 的 数学 模型 分 析 


前 面 的 章节 介绍 了 描述 车 辆 横向 运动 的 各 种 模型 ,能够 用 来 求解 在 车 辆 的 设 
计 、 分 析 和 评价 车 辆 性 能 中 过 到 的 不 同 问题 ， 但 越 是 多 自由 度 的 数学 模型, 就 需 
要 车 辆 的 理想 化 假设 条 件 越 多 ,这 种 理想 假设 条 件 与 实际 车 辆 的 情况 是 有 着 很 多 
差别 的 ,而 对 于 无 人 驾驶 车 辆 方向 盘 操作 控制 ,在 大 多 数 的 横向 控制 算法 设计 中 ， 
一 个 简单 的 “自行 车 模型 "已 经 能 够 提供 充分 准确 的 动力 学 描述 。 


4.1.1 ”车 辆 横向 动力 学 模型 


最 基本 的 车 辆 动力 学 模型 可 由 一 单质 量 刚 体 来 表示 , 车 辆 在 道路 水 平面 内 运 
动 时 ， 受 外 力 和 外 力矩 作用 下 可 分 为 三 个 自由 度 的 运动 ， 分 别 为 横向 运动 ， 纵向 
运动 和 横 摆 运动 。 本 章 讨论 车 辆 的 模 向 运动 特性 ,假设 车 辆 以 速度 行驶 ， 不 考虑 
纵向 动力 ， 只 分 析 横向 运动 和 横 皖 运 动 两 个 自由 度 的 动力 学 特性 。 

我 们 根据 车 辆 的 受 力 情况 来 建立 动力 学 模型 作用 于 车 辆 的 外 力 与 外 力矩 主 
要 有 两 种 , 轮胎 力 和 空气 动力 ,驾驶 员 对 车 辆 运动 施加 控制 的 作用 机 理 主要 来 自 
于 轮胎 ,轮胎 在 三 维 空间 上 主要 受到 纵向 、 侧 向 及 垂直 三 个 方向 的 作用 力 ， 和 这 
三 个 作用 力 产生 的 力矩 。 车 辆 速度 变化 主要 纵向 作用 力 影响 的 结果 , 车 辆 的 油门 
路 板 和 变速 器 主要 对 车 速 进行 控制 , 制 动 力 则 通过 制 动 系 统 使 车 辆 阐 车 , 侧 向 力 
则 对 车 辆 行驶 方向 产生 影响 。 驾驶 员 通 过 转向 系统 是 轮胎 产生 一 个 转向 角 ,以 此 
来 控制 轮胎 的 侧 向 力 。 轮胎 的 和 向 力 的 作用 是 使 车 辆 具有 良好 的 附着 性 能 。 而 对 
于 一 般 城市 道路 车 辆 而 言 , 空气 动力 的 影响 很 小 , 它 主要 影响 着 车 身 的 外 形 设计 ， 
我 们 在 车 辆 控制 器 的 设计 问题 中 可 忽略 不 计 (Rajesh Rajamani,2006)。 
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在 以 下 的 理想 化 假设 下 , 我 们 建立 描述 车 辆 横向 运动 的 简化 二 自由 度 基本 操 
纵 模型 ， 

D 假设 道路 平坦 ， 即 忽略 道路 委 直 方向 起 伏 所 造成 的 影响 ， 忽 略 车 辆 动力 

学 中 垂 向 力 影 响 作 用 ; 

2) 假设 整个 车 辆 是 刚性 的 ; 

3) 输入 信号 直接 作用 于 车 辆 前 轮 ， 不 考虑 车 辆 的 方向 盘 转向 系统 ; 

4) 忽略 空气 阻力 的 影响 ; 

5) 假设 车 辆 运动 学 方程 为 线性 方程 。 

由 于 基本 模型 不 考虑 轮胎 的 左右 载荷 转移 ， 所 以 也 不 必 考 虑 车 辆 的 宽度 ,为 
了 简化 计算 , 我 们 将 四 轮 车 辆 模型 简化 为 两 轮 模 型 ,左右 两 个 轮胎 的 合力 作用 在 
车 轴 上 ， 生 成 单轨 操作 动力 学 模型 ， 通 常 被 称 为 "自行 车 模型 "， 如 图 4.1 所 示 。 


Y 





图 41 简化 二 自由 度 车 辆 动力 学 模型 


本 文 研究 的 无 人 驾驶 车 辆 平台 智能 先锋 "的 转向 方式 为 前 轮转 向 , 其 原理 是 
通过 机 械 传动 机 构 将 方向 盘 的 转角 转换 为 前 轮转 向 角 ,以 此 来 操纵 汽车 的 行驶 方 
向 。 

我 们 以 车 辆 质心 为 原点 ， 建 立 Oyz 坐标 ， 其 中 x 轴 为 车 辆 运动 方向 ，z 轴 
垂直 与 地 面向 下 , 。 车 辆 的 三 个 自由 度 分 别 为 : 沿 x 方向 的 前 进 速度 u Hy N 
向 的 横向 速度 vr 为 绕 z 方 向 的 模 所 角速度 。 分 别 以 FFx 和 ZFy 表示 x 和 方 
向 的 合 外 力 ， 以 ZH 表示 绕 z 辐 的 合 外 力矩 ， 若 车 辆 的 质量 为 四， 模 摆 转动 避 量 
AL 则 系统 运动 方程 写成 如 下 形式 

m(i-w)= DF, 


m(b+ur)= JF, 
EF=EM, 


a) 
42) 


(43) 
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uw 表示 车 辆 质点 处 的 前 向 速度 ， 数 值 通常 不 会 很 小 ， 所 以 ， 可 以 将 u 写 成 : 

= + A ua 

式 中 ，xw 表 示 车 辆 的 恒定 前 进 速度 ， 而 Ax 是 相对 于 车 速 u 的 一 个 扰动 量 。 

我 们 考虑 车 辆 匀速 行驶 即 ZF=0, 并且 在 小 扰动 条 件 下 ,4wu, 和 vw 的 值 可 以 忽略 ， 
方程 可 被 解 耦 ， 并 得 到 两 自由 度 模型 ; 


m(o+u,r)= DF, (45) 
G=M, 46 

车 前 轴 两 轮胎 的 侧 向 合力 为 Ft, 后 轴 两 轮胎 的 侧 向 合力 为 yr， 车辆 质心 到 
前 后 轴 的 距离 分 别 为 a，5。 我 们 将 前 后 轮 的 侧 向 合力 分 开 考 谍 ， 则 有 


n+ 六 = Fy +E, 


4.7) 
B= aE -bE an 
若 已 知 轮胎 侧 偏 刚 度 C， 则 有 轮胎 侧 向 力 F, SRM a 的 关系 
Hee (49) 
其 中 ， 后 轮 为 非 转向 轮 ， 因 此 后 轮 侧 偏 角 可 近似 表示 为 
a,x 
(4.10) 





当 转 向 机 构 对 前 轮 产生 一 个 转向 角 Sp 定义 顺 时 针 为 正方 向 ， 则 前 轮 侧 偏 角 
近似 为 





ue 4.11) 
代入 运动 方程 (4.7)、(4.8) 可 得 


(aC, -bC,) 
Se girs (4.12) 





m(i-+u,r) =C,5, EtG), 
We fe 
_2C,-B°C,) 


maca OD, 
5 


(4.13) 


将 其 转化 为 标准 的 状态 空间 方程 ， 形 式 如 下 
文 =AX+BU (4.14) 


式 中 
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EN 





其 中 





质心 至 前 轴 
距离 wm 


质心 至 前 后 
轴 距 离 
bim 














我 们 假设 车 辆 以 10m/s 的 速度 匀速 运动 (we=10m/s)， 并 参考 奇瑞 瑞虎 车 的 
模型 参数 〈 见 表 4.1)， 可 以 得 到 车 辆 的 运动 方程 为 


A [ 7.5699 网 四 
s|" a 
Lt 0.9371 -9.8698 jr] |27.6864 (415) 


假设 车 辆 以 一 种 稳定 的 转弯 状态 行驶 ， 该 状态 车 辆 的 前 进 速度 和 前 轮转 
向 角 均 恒定 。 根 据 状态 方程 (4.14)， 得 到 横向 速度 ， 横 摊 角 速度 的 阶 跃 响应 曲线 
如 图 42。 
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图 4.2 横向 速度 ， 模 摇 角速度 的 阶 跃 响应 曲线 


4.1.2 求解 问题 的 状态 空间 描述 


在 上 一 节 建 立 的 运动 方程 中 ， 两 个 状态 变量 分 别 是 横 择 角 速度 和 横向 速度 。 
本 章 设计 横向 控制 器 ， 目 的 是 减 小 相对 于 期 望 轨迹 的 位 置 与 方向 误差 。 因此 我 们 
需要 基于 上 一 节 的 运动 方程 建立 关于 轨迹 误差 的 数学 模型 。 在 状态 方程 (4.14) 我 
们 添加 两 个 状态 量 ，er，ez， 分 别 表示 车 辆 质心 位 置 到 期 望 轨迹 线 的 距离 误差 和 
车 辆 相对 于 轨迹 线 的 方向 误差 。 

考 虚 车 辆 在 半径 为 常数 R 的 车 道上 以 恒定 的 纵向 车 速 we 行驶 ， 并 假设 半径 
R 很 大 ， 使 得 上 一 节 的 小 角度 假设 成 立 ， 定 义 车 辆 理论 的 方向 变化 率 为 : 


by, =H 
oe (4.16) 
车 辆 的 方向 误差 定义 为 ， 
e 20-0 
(4.172) 
定义: 
é, =v+u,0-8,) 
(4.18) 
将 式 (4.17)、(4.18) 代 入 式 (4.12)、(4.13)， 可 得 
mal- -Leprel CC tl- Ce Gey 
w rC, Ch j.c, i 
4.19) 
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L&Clsret Ches Chrocy, -Cn 


CE 
U tk CO Ue le (420) 


由 此 可 得 ， 跟 踪 误差 变量 的 状态 方程 : 


alp 1 o 0o Jafo 0 
&,|_|o -7.5699 75.699 1.6654 |a| |34.4086 -8.3346 
flo o 0 1 fel} o POH o Po 
al lo osm -9371 -98698| sa | |27.6864 -98698| © 


4.13 ”相对 道路 的 车 辆 运动 学 模型 


上 一 节 讨 论 的 动力 学 模型 是 基于 车 辆 坐标 系 下 ， 相对 于 道路 是 独立 的 ， 因 为 
道路 轨迹 跟踪 控制 需要 控制 的 是 相对 于 道路 的 位 置 误差, 需要 建立 以 道路 为 基础 
的 车 辆 运动 学 模型 , 如 图 4.3 所 示 , 车 辆 质心 和 期 望 轨迹 线 之 间 的 横向 距离 为 er 
因此 可 以 得 到 地 面 坐标 系 下 车 辆 位 置 为 ; 

X= Xu- sin) dzd 


Y=Y +e, COS(0) (4.23) 





图 43 以 道路 为 基础 的 车 辆 运动 学 分 析 
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RP Mes, Tu) 表 示 车 辆 模 轴 所 在 的 直线 与 期 望 轨迹 线 交点 的 地 面 坐标 ， 且 
有 : 


Xa [¥-c0s(0,,,)at 
è (424) 


Yaa = V sin(0,,,)dt 
ò (4.25) 


分 别 代入 式 (422) 和 式 (4.23)， 可 得 到 车辆 的 地 面 坐标 为: 
X= [V cosl, )dr -e sin(e, +gu) 
è 


(4.26) 
Y = [Y sin(a dt +e, cosle, + 0%) 
è 427) 
42 车 辆 横向 控制 系统 分 析 
4.2.1 ”状态 反馈 控制 设计 
在 上 一 节 式 (4.21) 所 得 到 的 车 辆 模型 状态 方程 可 表示 为 : 
j= Art B+ BO um 
其 中 
人 ,ea 名 三 
求解 矩阵 A 的 特征 值得 : 


= (0,8.7198+2.5471i,-87198-2.5471i0}" (4,20) 


可 以 看 出 ,矩阵 A 在 初始 时 有 两 个 不 稳定 的 特征 值 ， 系 统 需 要 通过 状态 反 
馈 环 节 使 系统 稳定 。 因 此 取 : 


6=-Kr=-he -kë -he, -khé (430) 
加 入 状态 反馈 后 系统 的 状态 方程 变 为 : 
= (A-BK)x+B,6,, (431) 


AREAS ATT KONE, RTT SEHR. 
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422 输出 反馈 


一 般 驾驶 员 的 开车 行为 都 是 符合 预 罗 跟 随 模 式 的 ,根据 预 蜡 女 随 理 论 ， 车辆 
相对 于 路 面 的 横向 误差 通常 以 车 辆 前 方 的 某 一 位 置 的 预 瞄 点 为 基准 ， 如 图 4.4 所 
T. 即 指定 给 定 轨迹 中 的 一 点 ， 通 过 计算 该 点 和 车 辆 的 相对 位 置 ， 并 根据 车 辆 当 
前 速度 ， 确 定 方向 盘 转角 信号 ， 使 车 辆 向 该 点 移动 。 在 这 一 过 程 中 ,考虑 采用 以 
车 辆 为 坐标 原点 的 局 部 坐标 系 ， 将 GPS 坐标 称 为 全 局 坐标 系 ， 控 制 系统 采用 频 
率 为 10Hz。 





图 44 车 辆 模 向 运动 过 程 中 的 坐标 系 


车 辆 槛 向 运动 过 程 中 的 党 标 系 如 图 4.35 所 示 ， 其 中 O 为 全 局 坐标 系 ， 
站 OL 为 局 部 举 标 系 ， 设 0.4 为 给 定 轨迹 ， 其 中 A AMA, AB 垂直 于 
8,0.8 为 预 暗 距 离 ， 六 为 模 向 位 置 偏差 ，9 为 航向 角 偏 差 

通过 GPS 信号 可 以 获得 0: 相对 于 正 北 的 夹 角 ang _n， 以 及 Ot，A NEA 
度 (ong O, lat O.) (long _4,lat_A4)。 华 标 转换 过 程 中 有 以 下 关系 


z 
£30,C == -ang _n 
人 (432) 


ac (433) 
AC 


=> 240, B = © -ang _n-arctan A 
2 oc 434) 
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根据 经 纬度 计算 距离 公式 ; 
0,A=111.12c0s{l/[sinlat _O, sinlat_A+ 
(435) 
coslat_O, coslat _ Acos(long _ A-long _0,)]} 


yı =0,Asin(240,B) 
(4.36) 
当 车 辆 与 道路 偏差 较 小 时 ， 可 以 认为 方向 角 误 差 很 小 , 弦 长 可 以 近似 等 于 弧 
长 ， 那 么 系统 的 输出 可 以 表示 为 : 
y=atde, ， (437 


RP, d, HWER. 


423 PID 控制 闭环 系统 


图 4.5 所 示 为 闭环 系统 的 结构 图 ， 其 中 P(s) 表 示 车 辆 转向 角 输入 和 系统 输出 
y 之 间 的 传递 函数 ，C(s) 表 示 用 于 控制 器 的 传递 函数 ， 将 在 之 后 的 章节 讨论 由 
路 面 决定 的 理论 横 摆 角速度 通过 传递 函数 G(s) 来 影响 系统 动力 学 。 信 号 nw 
响 系统 的 传感器 噪声 。 











图 45 闭环 系统 结构 图 


由 状态 方程 (4.31) 可 知 ，P(S) 的 状态 空间 转移 矩阵 为: 
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é) fo 1 0 0 Ta 0 

| |0 -7.5699 75.699 1.6654 |å | |344086 
,|= + (0) 
àjo o 0 1 je 0 


ëj [0 09371 -9371 ~9.8698] é,| |27.6864 
考虑 上 一 节 定义 的 系统 输出 为 : 


(4.38) 


yretde, (4.39) 
将 闭环 系统 输出 表示 为 : 
Y=CX+DU (4.40) 


式 中 
c=h 0 a, op=0 
若 取 di-10， 转 换 为 车 辆 前 轮转 角 到 位 置 误差 输出 的 传递 函数 ， 有 ， 
G(s)=C(sI-A)"B+D 


= 311.38? +28048+2418 
s* +17.44s’ +82,52s" (4.41) 
我 们 把 上 文 推导 出 的 车 辆 转向 控制 系统 的 传递 函数 写成 
1 311.3s* +2804s+2418 _ 1 


ea rt PAO (442) 


开 环 传递 函数 G(s) 在 原点 有 双重 极点 。 如 果 用 一 个 比例 控制 器 控制 反馈 回 


路 ， 则 CG)-=K， 天 为 控制 器 增益 。 


根据 系统 根 轨迹 〈 图 4.6) 可 以 看 出 ， 当 使 用 适当 大 的 增益 时 ， 带 比例 控制 
的 闭环 系统 是 稳定 的 ,在 较 小 的 增益 下 是 不 稳定 的 但 通过 分 析 系统 的 频 域 特性 ， 
绘制 Bode 图 看 出 ， 随 着 比例 增益 增 大 ， 虽 然 闭环 系统 变 得 稳定 ， 但 它 的 相位 容 
度 很 小 。 在 图 4.7 中 ， 比 例 增益 为 1 时 ， 得 到 的 相位 裕 度 为 18 度 ， 并 且 此 时 是 


系统 所 能 获得 的 接近 最 好 的 相位 裕 度 。 此 时 的 阶 跃 响应 曲线 如 图 4.8。 
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图 4.7 控制 系统 频 域 特性 
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图 4.8 单位 阶 路 响应 曲线 


如 图 4.8 可 见 系统 的 超 调 量 很 大 ， 动 态 性 能 较 差 ， 要 满足 设计 要 求 ， 考 虑 进 
一 步 设计 PID 控制 器 : 
K, 
CO)=K, + +tKos i 
我 们 取 Ko=1，Kr0.5，Ko=0.25， 对 系统 进行 仿真 ， 得 到 阶 跃 响应 曲线 ， 如 
图 4.9。 由 图 可 以 看 出 ， 通 过 串联 PID 控制 器 ， 系 统 性 能 得 到 了 很 大 的 改善 。 


图 49 了 PID 控制 单位 阶 跃 响应 曲线 


ss 
sise 000000 


第 四 章 车辆 横向 动力 学 及 横向 控制 方法 





43 ”基于 小 脑 模型 神经 网 络 与 PID 复合 的 自 适应 控制 器 设计 


上 一 节 关于 无 人 驾驶 车 辆 控制 系统 的 讨论 都 是 基于 车 辆 匀速 行驶 并 且 是 在 
小 的 转向 情况 ， 适 用 于 在 道路 通畅 ， 并 且 无 较 大 转弯 的 情况 ， 如 高 速 公路 。 考 虑 
到 城市 交通 环境 复杂 ， 需 要 经 常 更 改 路 径 ， 频 繁 地 变换 速度 ， 此 时 上 述 关 于 车 辆 
动力 学 的 假设 将 不 再 成 立 ， 实 际 的 情况 会 存在 以 下 各 种 不 确定 因素 : 

。 系统 模型 参数 的 变化 ; 

。 未 建 模 的 动力 学 ; 

。 未 建 模 的 系统 时 延 ; 

。 平衡 点 的 变化 ; 

，。 传感器 噪声 以 及 传感器 时 延 ; 

。 不 可 预测 的 干扰 输入 

所 以 我 们 希望 在 模型 不 太 精确 或 存在 其 他 变化 因素 的 条 件 下 , 系统 仍然 能 够 
保持 预期 的 性 能 。 对 于 具有 时 延 和 参数 时 变 的 控制 系统 ，PID 参数 只 有 不 断 地 根 
据 对 象 参数 的 变化 进行 适应 性 的 自 整定 或 调整 ， 才能 得 到 最 优 的 控制 效果 , 因此 
我 们 考虑 设计 一 种 小 脑 模型 神经 网 络 与 PID 复合 的 控制 器 ， 使 控制 器 具有 自学 
习 能 力 ， 能 够 自动 补偿 被 控 模型 和 输入 信号 发 生 的 非 预知 的 变化 。 


43.1 CMAC 的 结构 与 原理 


小 脑 模型 神经 网 络 ， 英 文 全 称 为 Cerebellar Model Articulation Controller ， 
简称 CMAC， 它 是 查 表 型 自 适应 神经 网 络 ， 它 可 以 准确 地 描述 出 非 线性 函数 的 
特征 , 同时 , 具有 学 习 功 能 , 可 依据 学 习 结 果 改 变 表格 内 容 , 对 信息 可 区 分 存储 。 
人 类 的 小 脑 主要 是 对 运动 产生 作用 。 在 人 类 神经 学 的 研究 中 , 它 由 含有 一 些 神经 
元 斤 盖 组 成 。 在 这 项 研究 的 基础 上 ，Albus J.S.(1975) 提 出 了 CMAC, 它 具 有 人 类 
小 脑 一 般 学 习 的 功能 , 在 多 维度 空间 中 进行 映射 ， 解 决 了 输入 端 到 输出 端 非 线性 
的 问题 。CMAC 是 一 种 局 部 逼近 神经 网 络 ， 它 具有 一 种 联想 记忆 的 功能 ， 它 的 
每 一 个 神经 元 的 输入 输出 是 一 种 线性 关系 , 但 总 体 上 是 一 种 表达 非 线性 映射 的 表 
格 系统 。 常 用 于 模式 识别 、 人 工 智能 、 信 号 处 理 、 机 器 人 控制 以 及 自 适应 控制 等 
研究 领域 。CMAC 与 其 他 神经 网 络 相 比 ， 优 点 在 于 (Albus ].S.1991): 
1) 它 是 局 部 通 近 神经 网 络 ， 它 只 对 输入 空间 的 小 部 分 范围 进行 训练 ， 只 有 
相应 小 部 分 的 几 个 权 值 调节 神经 网 络 的 输出 ， 因 此 对 于 每 次 的 输入 输出 
数据 需要 调整 的 权 值 很 少 ， 学 习 速 度 比 全 局 神经 网 络 要 快 ， 更 能 符合 实 
时 控制 的 要 求 ; 

2) 它 具 有 较 强 的 输入 和 输出 的 映射 能 力 ， 并 且 可 以 根据 不 同 的 精度 要 求 来 
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通 近 任意 类 型 函数 。 
3) 它 具 有 一 定 的 泛 化 能 力 ， 对 具有 同一 规律 的 学 习 集 以 外 的 数据 ， 经 过 
训练 ， 网 络 也 能 给 出 合适 的 输出 。 
4) 其 查 表 寻 址 方式 ， 易 于 计算 机 编程 实现 ， 网 络 形式 简单 ， 在 线 计算 速度 
k 
CMAC 把 控制 器 的 每 个 输入 状态 作为 一 个 状态 向 量 ， 组 成 一 个 输入 空间 。 
把 网 络 训练 的 权 值 存 入 存储 器 , 并 根据 期 望 输出 与 实际 输出 地 误差 来 调整 这 些 权 
值 。 它 实际 上 是 一 种 复杂 的 查 表 系 统 ， 主 要 用 于 表达 非 线性 的 映射 。CMAC 的 
模型 结构 如 图 4.10 所 示 ， 它 有 两 层 映 射 关 系 ， 表 达 系统 输入 与 输出 的 非 线性 关 
系 , 其 具体 做 法 是 将 输入 状态 空间 量化 为 离散 的 点 , 每 个 离散 点 对 应 于 一 个 实际 
存储 器 单元 并 作为 一 个 神经 元 ,每 个 离散 点 经 训练 调整 过 后 权 值 分 布 存储 在 相 邻 
几 个 存储 器 位 置 上 。 











图 4.10 CMAC 结构 示意 图 


CMAC 的 工作 原理 如 下 
(0 概念 喘 射 (U->AC) 
概念 映射 (Conceptual Mapping) 是 一 种 输入 空间 U 内 的 映射 ， 映 射 至 虚拟 的 
存储 器 AC (Serrano FJ.et al.,1998)。 
假定 输入 的 数值 向 量 为 zu 维度 为 mw， 则 有 : 
Uy = [Wap tags tg] (444) 
对 输入 量 进行 量化 ， 表 示 为 [ww]， 每 一 个 量化 的 输入 状态 点 激活 存储 器 中 的 
对 应 c 个 单元 , c 也 称 为 CMAC 网 络 的 感知 器 个 数 。 喘 射 后 的 输出 向 量 可 以 用 下 
式 表示 : 
R, = Se, D= (lu, Disses, DY (4.45) 
a 
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Rp, 
supl jE c 


输入 空间 中 的 临近 两 点 通过 映射 作用 激励 存储 器 AC 中 部 分 重合 的 单元 , 这 
两 点 的 距离 越 近 ， 重 合 的 部 分 越 多 ， 相 距 较 远 的 点 在 AC 中 不 会 产生 重合 ， 这 样 
就 实现 了 网 络 的 局 域 泛 化 。 
(2) 实际 映射 《AC->AP) 
实际 映射 Practical mapping) 是 指 利用 哈 希 编码 (Hash Coding) A, 2 
示 概念 存储 器 AC 的 “个 存储 地 址 与 实际 存储 器 AP 相应 的 c 个 存储 地 址 的 映射 
关系 ， 在 个 存储 地 址 中 存储 网 络 训练 的 权 值 ， 网 络 输出 是 实际 存储器 AP 中 存 
储 的 对 应 c MERRER. 
车 只 考 谍 单 输出 的 情况 ， 有 : 
¥= $w (uD = RH, 
” (446) 
式 中 ， 
W, =[W ww owe) 


将 式 (4.45) 带 入 式 (4.46)， 则 有 : 
w= Sm, 
i (447) 


上 文 提 到 的 哈 希 编码 也 称 哈 希 存储 , 是 一 种 常用 的 计算 机 数据 存储 算法 , 利 
用 哈 希 表 存 储 数据 ， 以 实现 数据 的 压缩 存储 ( 严 蔚 敏 ， 等 ，1996)。 在 CMAC 神 
经 网 络 中 ， 当 输入 矢量 维 数 为 m， 并 且 每 个 矢量 的 量化 为 g MRM, Hin 9 
较 大 ， 存 储 器 AC 需要 的 空间 将 会 很 大 。 实 际 应 用 时 ， 网 络 训练 只 需要 局 部 的 调 
整 网 络 输出 层 的 权 值 , 即 在 存储 器 AC 中 被 激励 的 单元 ( 非 零 单 元 ) 是 相对 稀少 的 ， 
利用 哈 希 存储 方法 , 可 以 将 AC 空间 进行 压缩 , 压缩 后 数据 存储 到 存储 器 AP 中 ， 
哈 希 存储 有 多 种 方法 ， 其 中 除 留 余数 法 是 较为 容易 实现 的 一 种 。 

除 留 余 数 法 是 取 地 址 数值 被 某 个 不 大 于 哈 希 表 长 m 的 质数 p 除 后 ， 用 所 得 
的 余数 作为 秀 列 地 址 ( 徐 士 良 ,2005)。 对 于 CMAC 来 说 是 将 输入 矢量 在 存储 器 AC 
中 的 存储 地 址 除 以 一 个 质数 ， 取 余数 作为 在 存储 器 AP 中 的 地 址 。 


43.2 CMAC 的 学 习 算 法 


考虑 单 输出 系统 ， 给 定 输 入 /输出 样本 对 ， 采 用 有 导 和 师 的 学 习 算 法 ， 取 导师 
{ETA udp P=1, 2, ... Le RRS 学 习 规则 修正 网 络 权 值 : 


a 
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ve 0 =p AG A) 
z 
kl (4.48) 
由 式 (4.45) 和 式 (4.46) 可 知 
RI -$u 
m (4.49) 
代入 式 (4.48) 可 得 
m aw =n LED) 7 0 


c (4.50) 


为 了 在 CMAC 中 产生 一 个 非 线性 映射 函数 ， 步 骤 如 下 ; 

(1) EER CMAC 产生 的 目标 非 线性 函数 为 六 ,那么 对 输入 矢量 u, y*f* 
多 就 是 输出 矢量 的 期 望 值 。 

(2) 在 输入 矢量 中 取 一 个 点 w 计算 该 点 的 函数 值 =Aw)。 

(3) 对 应 y*=O1*, y2% .yn 和 y=(y1,y2, .… ym) 中 每 两 点 ， 如 果 | y4* -| 
符合 误差 允许 的 要 求 ， 就 停止 训练 ， 函 数 的 各 参数 存储 至 存储 器 中 ; 如 果 |y,* -y 
|<e， 那 么 对 网 络 对 应 的 权 值 w 增加 4w，4w 的 计算 按 式 (4.50)。 

(4) 重复 以 上 步骤 ， 直 至 各 输入 矢量 计算 的 误差 都 小 于 允许 的 范围 。 


433 CMAC 与 PID 的 复合 控制 


正如 入 类 的 小 脑 是 用 来 控制 运动 的 ， 小 脑 模型 神经 网 络 (CMAC) 最 早 就 被 用 
于 机 器 人 运动 控制 领域 ， 现 已 有 多 样 的 控制 模式 ， 如 反馈 控制 模式 ， 直 接 逆 运动 


控制 模式 , 前 馈 控 制 模式 等 (King - Lung Huang,et al.,1997; Chiang&Lin, 1996), 本 “ 


文采 用 CMAC 的 前 镇 控 制 方式 ， 通 过 CMAC 和 PID 的 复合 结构 实现 系统 控制 
CMAC 5 PD 复合 控制 结构 框图 如 图 4.11 所 示 。 在 该 控制 结构 中 ，CMAC 
控制 环节 通过 网 络 训练 实现 对 非 线性 被 控 对 象 模型 的 过 近 。 PID 反馈 控制 环节 实 
现 控制 的 准确 性 并 保证 系统 的 稳定 性 和 重 棱 性 。 可 见 该 控制 结构 是 前 馈 反 馈 控 
制 。 仿 设 高 艇 形式 下 ， 被 控 对 银 的 状态 措 述 为 : 
x(k+1) = giu) si) 


式 中 ,x 为 系统 状态 向 量 ，u 为 控制 向 量 ;8[] 为 非 线性 特性 函数 。 
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图 4.11 QUC 与 PID 复 合 控制 结构 框图 


对 于 该 系统 ，CMAC 控制 环节 是 通过 学 习 训练 被 控 对 象 的 动态 特性 ， 获 得 
系统 控制 输入 量 u SRE x 的 关系 : 
u(k) = g (x(k), x(k +1)] (4.52) 
该 系统 通过 CMAC 和 PID 的 复合 控制 实现 系统 闭环 控制 ，PID 作为 反馈 环 
节 ， 能 够 确保 控制 的 准确 性 和 平稳 性 ， 且 能 够 减少 干扰 影响 。CMAC 环节 作为 
前 局 ， 能 够 逼近 车 辆 横向 运动 的 逆 动 态 模型 ， 减 少 控制 的 稳 态 误差 ， 减 小 系统 超 
调和 响应 时 间 。 
(1) 控制 周期 
系统 给 定 下 一 控制 周期 的 期 望 状态 为 Xs( 习 二 Xi(kt1), 由 CMAC 控制 器 部 分 
产生 的 控制 量 w(K), h PD 部 分 产生 的 控制 量 为 u(k)， 被 控 对 象 的 控制 量 总 的 
MAH: 
= +408) (433) 
(2) 学 习 周期 
系统 产生 的 实际 状态 x(k) 作 为 CMAC 网 络 下 一 时 刻 的 输入 , 由 CMAC 产生 
的 控制 量 为 uw( 嫩 。 取 xb 为 导师 信号 ， 按 5 学 习 规 则 修正 存储 器 AP 中 的 权 值 ， 
算法 表示 为 : 
AW(k) = Mu(k) ~u, (Je usy 
RP, n 为 网 络 设 定 的 学 习 速率 。 
取 控 制 系统 的 初始 值 为 WO0, HR wn(0)=0，w(0) 二 ue(0)。 仅 PID 控制 作 
用 于 系统 ， 随 网 络 对 误差 及 误差 变化 的 学 习 训练 ， 经 由 CMAC 产生 的 控制 量 un 
将 逼近 系统 跟踪 的 理想 输入 w， 其 中 w 可 以 表示 如 下 : 
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4, (E) = NAK), x KWON (455) 
与 式 (4.55) 比 较 可 知 ，NO@[-]=g 7， 这 里 用 xs=x《k+1) 代 替 了 x(k+1)。 


O 复合 控制 算法 
根据 上 文 所 述 CMAC 的 训 丝 方法 ,在 每 一 步 的 控制 中 ,根据 这 一 周期 CMAC 
存储 单元 中 的 权 值 得 到 对 应 的 CMAC 控制 量 wu， 根据 系统 输入 与 输 册 之 间 的 
误差 和 设 定 的 学 习 连 率 修正 相应 的 权 值 、 
CMAC 权 人 的 调整 算法 为 
EGR) = Hulk) (8))? oe 
c (4.58) 


awoon OHO 5 opita, 
e c (4.59) 


wk) = w(k-1) + Aw(k) (4.60) 


式 中 ，ai 为 二 元 联想 向 量 ， 以 数值 1" 和 "0" 表 示 第 i 个 单元 是 否 被 激活 ; c 
为 CMAC 的 感知 器 个 数 ，un( 局 为 系统 中 CMAC 环节 上 时 刻 产生 的 控制 量 : 为 
学 习 常 数 ，nE(0,1)。 
CMAC 控制 的 输入 量 为 
u,(k) = 六 wa 
各 (4.56) 
全 系统 的 输入 量 为 : 


u(k) =u, (k) +u, (k) (4.57) 


RP, w(K) PID 环节 产生 的 控制 量 。 

由 以 上 的 描述 可 知 ，CMAC 与 PID 的 复合 控制 中 ， 系 统 中 PID 控制 部 分 的 
作用 是 增强 系统 的 重 棒 性 ， 而 CMAC 控制 部 分 是 增强 系统 的 自 适应 性 。PID 控 
制 单 独 作用 时 ，PID 各 参数 的 值 决定 着 控制 效果 ， 控 制 系统 工 况 发 生 改 变 就 需要 
对 系统 参数 重新 整定 ， 而 采用 PID 与 CMAC 的 复合 控制 后 ， 控 制 效果 不 再 局 限 
于 PID 参数 的 值 ， 当 对 象 或 环境 发 生变 化 时 ,. 由 于 CMAC 的 作用 可 以 使 系统 的 
控制 性 能 在 一 定 的 范围 内 自动 的 调整 。 


43.4 CMAC 与 PD 的 复合 控制 仿真 结果 
根据 前 文 对 车 辆 横向 运动 已 经 建立 的 模型 , 车 辆 前 轮转 角 到 位 置 误差 输出 的 
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传递 函数 为 


在 比较 理想 的 条 件 下 ， 取 PID 控制 参数 为 K=1，K=0.5，Kp=0.25 时 可 以 得 
到 良好 的 控制 效果 。 为 了 验证 在 连续 变化 的 较 大 转向 角 输 入 的 控制 效果 , 设计 了 
PID+CMAC 控制 器 和 单纯 PID 控制 器 对 比 仿真 实验 。 采用 周期 为 10ms， 采样 时 


3113s? +2804s +2418 


OOS FITAS + 82.525" 


间 为 10s， 取 输入 信号 为 正弦 信号 。 


其 跟踪 结果 如 图 4.12 和 图 4.13 所 示 , 其 中 图 4.14 分 别 给 出 了 CMAC 5 PID 
复合 控制 中 的 CMAC 的 控制 器 、PID 控制 器 和 总 控制 器 的 输出 。 由 仿真 结果 可 
见 ， 控 制 过 程 初始 时 PID 控制 起 主要 作用 ， 通 过 对 控制 过 程 的 学 习 ， CMAC 控 
制 逐 渐 发 挥 作用 ， 在 0.4s 的 训练 时 间 之 后 ， 系 统 能 够 准确 的 跟踪 输入 信号 。 引 
入 CMAC 控制 环节 后 ， 系 统 对 动态 输入 的 跟踪 误差 减 小 ， 并 能 稳定 的 跟踪 输入 


信号 。 


(Gin signal) 





02 os 


图 4.12 9% PID 控制 正弦 信号 跟踪 曲线 





02 08 


图 4.13 CMAC 与 PID 复合 控制 正弦 信号 跟踪 曲线 
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图 4.14 CMAC H PID 复合 控制 各 个 控制 器 的 输出 


为 了 验证 控制 系统 的 抗 干扰 性 ， 设 计 了 有 扰动 Matlab 仿真 实验 ， 参 数 设 定 
为 : 
采样 周期 10ms， 仿 真 时 间 ，10s。 
系统 干扰 输入 ;在 t=2s 时 控制 量 中 都 加 入 d=1 的 一 个 扰动 信号 。 
仿真 曲线 见 图 4.15 所 示 ， 其 中 图 4.16 显示 了 阶 跃 响应 时 的 各 个 控制 器 的 输 
出 量 。 

总 结 以 上 实验 的 结果 得 出 , CMAC 控制 器 的 加 入 使 控制 性 能 比 单纯 的 PID 控 
制 改善 了 很 多 。 在 跟踪 方 波 和 阶 跃 输入 时 ， 系 统 超 调 量 明显 减 小 。 在 跟踪 正弦 信 
号 时 , 提高 了 系统 的 跟踪 精度 , 而且 在 扰动 作用 时 仍然 能 很 好 地 对 正弦 指令 进行 
跟踪 。 此 外 引入 干扰 的 实验 也 验证 了 CMAC 控制 具有 较 强 的 抗 干扰 能 力 。 
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图 4.15 有 扰动 的 不 同 输入 信号 仿真 实验 响应 结果 
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图 4 16 有 扰动 的 仿真 实验 各 个 控制 器 输出 


43.5 CMAC 5 PID 复合 控制 的 实验 验证 


为 了 验证 CMAC 5 PID 复合 控制 算法 的 有 效 性 ， 本 文 以 “智能 先锋 "无 人 车 


为 平台 进行 了 相应 的 实 车 实验 。 图 4.17 显示 了 实验 所 设 定 的 参考 轨迹 由 一 系列 
GPS 坐标 点 表示 , 它 由 一 小 段 直道 和 连续 的 弯 道 组 成 , 用 来 测试 车 辆 的 动态 特性 
在 非 线性 变化 情况 下 控制 器 对 路 径 跟 踪 的 准确 性 ， 设 计 行 驶 速度 为 20kmh。 在 
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实验 中 ， 油 门 和 制 动 踏板 是 手动 控制 的 ， 以 确保 实验 的 安全 。 











197.1993 a aye ya 
amns 

manat 

mnnt 

mnnt 

“ow maa e i i i i SS 


图 4.17 轨迹 跟踪 实验 设 定 的 期 望 轨迹 


实验 参数 设 定 为 : 
PID 控制 参数 ，Kz=1，Kr0.5，Kor-025 
CMAC 的 映射 : 


808) = (u(t) tg) 


Me ii 
RP, unn 和 wx 是 输入 量 的 上 下 界限 值 ，M 为 wx 的 量化 值 。 根 据 哈 希 编 
码 方法 ， 有 CMAC 的 映射 关系 表达 式 : 
ad() = (s(k)+i MOD N)+1 


HP, 1=1,2,....c6 

在 实验 中 ， 取 M=100，N=5， 取 泛 化 参数 c=5,]=la=0.4。 

跟踪 结果 如 图 4.18 和 图 4.19 所 示 , 其 中 图 4.18 为 单独 PID 控制 作用 下 的 轨 
迹 跟踪 结果 ,图 4.19 为 CMAC: 与 PID 复 合作 用 的 轨迹 跟踪 结果 , 由 图 可 见 , CMAC 
与 PID 复合 作用 下 的 车 辆 轨迹 跟踪 精度 明显 优 于 单独 的 PID 控制 。 图 4.20 分 别 
给 出 了 CMAC 与 PD 复合 控制 中 的 CMAC 控制 器 、 PID 控制 器 和 总 控制 的 前 轮 
转角 的 输出 。 通 过 实验 结果 可 以 看 出 ， 通 常 状况 下 如 车 辆 行驶 在 非 弯曲 道路 时 ， 
此 时 横向 动力 学 近似 在 线性 范围 ， 采 用 一 般 的 PID 控制 方法 偏差 不 大 ， 车 辆 在 
预定 的 轨迹 上 偏离 不 多 ， 此 时 不 需要 CMAC 环节 的 介入 。 当 进入 曲线 行驶 时 ， 
CMAC 经 过 对 常规 控制 器 的 输出 不 断 学 习 ， 逐 渐 由 CMAC 控制 起 作用 ， 如 预期 
的 那样 ， 它 能 够 自动 补偿 被 控 模型 的 动态 变化 与 常规 PID 控制 一 起 作用 达到 良 
好 的 跟踪 能 力 ， 在 引入 CMAC 控制 环节 后 ， 系 统 对 动态 输入 的 跟踪 误差 有 所 减 
小 ， 并 能 稳定 的 跟踪 输入 信号 。 
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图 4.18 PID 控制 作用 下 轨迹 跟踪 结果 
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图 4.19 CMAC 5 PID 复合 控制 作用 下 轨迹 跟踪 结果 
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图 4.20 CMAC 控制 器 、PID 控制 器 和 总 控制 器 的 输出 


由 实验 结果 可 以 得 出 ; 基于 CMAC 与 PID 的 复合 控制 的 无 人 驾驶 车 辆 横向 
控制 算法 不 需要 有 非常 精确 的 数学 模型 ， 就 能 实现 准确 的 轨迹 跟踪 控制 。 从 以 上 
的 实验 结果 看 ， 在 运用 CMAC 方法 以 后 ， 系 统 的 超 调 且 明显 减 小 ， 响 应 时 间 缩 
短 ， 同 时 ， 动 静态 特性 有 所 改善 。 这 项 改进 使 得 无 人 车 在 复杂 的 城市 环境 和 多 变 
的 行驶 状态 中 行驶 的 平顺 稳定 。 该 控制 器 很 好 地 模拟 了 驾驶 员 的 真实 驾驶 行为 ， 
这 种 智能 控制 方法 对 于 城市 环境 中 的 无 人 驾驶 车 辆 的 横向 控制 这 一 种 复杂 的 控 
制 问题 无 疑 是 一 种 很 有 效 的 解决 手段 。 
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44 本章 小 结 


本 章 首先 将 车 辆 模 向 动力 学 化 简 为 最 基本 的 两 自由 度 车 辆 动力 学 模型 , 即 仅 
考虑 车 辆 的 横 摊 及 横向 运动 , 随后, 在 两 自由 基本 动力 学 模型 基础 上 将 无 人 车 辆 
轨迹 跟踪 的 控制 问题 描述 为 状态 空间 的 形式 并 设计 了 PID 控制 系统 ， 由 Matlab 
仿真 实验 验证 了 在 匀速 小 转向 情况 下 , PD 控制 器 具有 较 好 稳 态 特性 和 较 高 的 控 
制 精度 ， 但 是 在 城市 道路 中 驾驶 车 辆 ， 随 时 可 能 会 转向 、 变 道 或 改变 速度 行驶 。 
为 了 使 无 人 车 在 复杂 的 城市 环境 下 具有 更 高 的 自 适应 性 , 在 “ 预 瞳 一 跟随 "理论 模 
型 和 经 典 PD 控制 方法 的 基础 上 设计 了 一 种 小 脑 模型 神经 网 络 与 PID 复合 的 横 
向 控制 器 ，CMAC 具有 自学 习 能 力 ， 能 够 自动 补偿 被 控 模型 和 输入 信号 发 生 的 
非 预 知 的 变化 ， 本 文 利用 CMAC 和 PID 的 复合 控制 实现 闭环 控制 ， 其 中 ，PID 
作为 反馈 环节 ， 维 持 系统 的 稳定 性 和 重 棒 性 。CMAC 作为 前 馈 环节 ， 实 现 车 辆 
横向 运动 的 闻 动 态 模型 的 逼近 , 减 小 超 调 量 和 响应 时 间 ， 从 而 使 无 人 车 能 够 在 城 
市 环境 中 各 驾驶 任务 下 实现 稳定 、 准确 的 道路 跟踪 行驶 。 最 后 对 以 上 控制 方法 的 
仿真 结果 进行 简单 介绍 ， 实 验 验证 了 CMAC 与 PID 复合 控制 方法 ， 它 能 够 自动 
调整 控制 器 参数 ， 提 高 控制 系统 动态 特性 ， 并 具有 一 定 的 抗 干扰 能 力 。 
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通过 前 面 的 分 析 , 我 们 已 经 建立 了 车 辆 纵向 及 横向 的 动力 学 模型 , 并 在 此 基 
础 上 设计 了 面向 城市 环境 的 无 人 驾驶 车 辆 的 控制 系统 ,本 章 将 在 Visio Studio2005 
环境 下 , 实现 前 面 所 设计 的 控制 算法 ， 对 整个 控制 系统 进行 实 车 实验 , 为 此 设计 
了 不 同 的 实验 场景 , 用 以 验证 无 人 驾驶 车 辆 在 不 同 环 境 下 的 控制 性 能 , 并 在 实验 
之 前 进行 了 城市 道路 行车 安全 性 的 探讨 。 


5.1 实验 设计 


按照 前 述 研究 结果 , 无 人 驾驶 车 辆 控制 系统 的 系统 功能 是 自动 控制 车 辆 平稳 
准确 的 跟踪 上 层 决 策 系统 规划 的 路 径 , 能 够 适应 城市 复杂 多 样 的 行车 环境 , 具有 
较 强 的 重 棒 性 并 能 保障 行车 安全 , 下面 利 用 实验 室 所 拱 建 的 无 人 驾驶 车 辆 验证 平 
一 一 “智能 先锋 "进行 典型 工 况 下 的 系统 功能 验证 试验 , 对 前 述 关于 汽车 纵向 和 
横向 控制 系统 各 项 功能 的 实现 情况 进行 验证 , 分 别 对 比 、 评价 了 车 辆 控制 器 在 不 
同 的 速度 下 应 用 PID 控制 算法 和 小 脑 模型 PID 控制 算法 后 不 同 的 车 辆 参数 、 结 
果 。 车 辆 行驶 轨迹 、 横 摆 角 速度 ， 车 辆 行驶 速度 通过 “智能 先锋 "的 GPS/INS 装 
置 进行 采集 。 
为 了 更 加 全 面 的 评价 本 文 所 采用 的 控制 算法 , 采用 两 种 典型 的 道路 作为 实验 
场地 ， 如 图 5.1， 图 5.2 所 示 。 





图 $1 矩形 实验 场地 
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S52"8" 字 型 本 因 实 验 场地 

图 5.1 为 一 类 似 答 形 场地 ， 由 四 段 直道 和 3 段 90 度 变 道 组 成 ， 该 环境 可 以 
对 无 人 车 在 直道 、 直 道 接 入 高 道 、 恋 道 转 入 直道 3 种 不 同 的 条 件 下 的 控制 器 指标 
进行 测试 。 


图 52 为 一 “8" 字 场地 ， 由 于 “8" 字 场地 的 道路 曲率 是 不 断 变化 的 ， 该 环境 可 
以 很 好 地 验证 控制 器 在 弯 道 条 件 下 的 控制 效果 。 


5.2 面向 城市 道路 的 无 人 驾驶 车 辆 行驶 安全 性 讨论 


在 城市 交通 问题 中 ,安全 显得 格外 重要 ， 因 此 无 人 驾驶 车 辆 在 进入 真实 道路 
测试 前 首先 应 保证 其 行驶 安全 性 。 车 辆 在 引入 人 类 社会 之 后 ， 既 为 人 类 的 生产 、 
生活 带 来 好 处 ， 又 带 来 了 一 些 危及 人 类 生命 的 事故 。 多数 的 交通 事故 都 是 由 于 驾 
驶 员 的 操作 不 当 为 引起 的 , 其 中 由 于 车 辆 制 动 性 能 较 差 ， 在 恋 道 时 由 于 制 动 不 够 
及 时 导 臻 车辆 偏离 预定 航线 而 产生 的 交通 事故 占 总 事故 数 的 三 成 以 上 ( 张 唤 业 ， 
等 ,2003)。 因 此 对 面向 城市 道路 的 无 人 驾驶 车 辆 行驶 安全 性 研究 是 非常 必要 的 ， 
并 且 具 有 积极 的 意义 。 


521 高 速 过 弯 或 换 道 的 行驶 安全 性 


人 类 对 车 辆 的 一 些 不 当 的 操纵 行为 会 使 车 辆 发 生 侧 翻 、 甩 尾 、 侧 滑 的 危险 。 
对 无 人 车 系统 来 说 ， 控 制 器 产生 不 当 的 输出 也 会 发 生 同 样 的 危险 。 因此 ， 对 车 辆 
控制 安全 性 的 研究 是 非常 有 必要 的 。 

前 面 两 章 为 了 便于 分 析 , 将 车 辆 横向 运动 与 纵向 运动 分 开 讨 论 ， 而 忽略 了 其 
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间 的 相互 硬 合 作用 ,实际 行 驶 在 城市 道路 中 的 汽车 是 一 个 参数 不 固定 且 不 可 线性 
化 的 系统 ,在 不 同 的 纵向 车 速 条 件 下 ， 车 辆 的 横向 运动 模型 是 不 一 样 的 ， 车 辆 轮 
胎 的 横向 力 在 纵向 上 的 分 力 对 纵向 速度 也 存在 着 影响 ， 尤 其 是 在 计 道 变速 行驶 
时 ， 要 兼顾 横向 控制 与 纵向 控制 的 参数 ， 不 能 只 单独 考虑 一 种 参数 ， 而 忽略 了 另 
一 种 参数 的 影响 , 所 以 , 将 横向 控制 与 纵向 控制 的 参数 独立 开 来 , 影响 控制 精度 ， 
从 而 影响 车 辆 行驶 的 安全 性 。 

当 驾驶 员 转动 汽车 方向 盘 后 , 转向 系统 使 车 辆 轮胎 形成 侧 偏 角 ， 由 此 形成 了 
施加 在 车 身 的 横向 力 , 在 横向 力 的 作用 下 , 车 辆 发 生 横 摆 运动 ( 安 部 正人 ，1998)。 
汽车 在 弯 道 半径 较 大 的 路 径 下 以 较 高 车 速 行驶 时 , 此 时 车 轮 和 路 面 有 足够 的 附着 
力 , 轮胎 产生 的 侧 向 力 与 侧 偏 角 之 间 近 似 是 线 性 关系 , 并 且 车 辆 会 表现 出 一 些 不 
足 转向 的 特征 ， 由 于 汽车 的 质心 侧 偏 角 非 常 小 。 

根据 车 辆 动力 学 理论 ， 车 辆 的 转向 特性 有 过 度 转向 、 中 性 转向 、 不 足 转 向 三 
种 稳 态 转向 特性 (Rajesh Rajamani,2006)。 当 汽车 高 速 行驶 时 ， 在 不 足 转向 的 情况 
下 , 在 线性 区 间 内 容易 操控 。 而 具有 中 性 转向 的 车 辆 极 易 变 成 过 度 转向 ， 易 发 生 
稳定 性 问题 造成 车 辆 的 失控 , 在 附着 系统 的 制约 下 ， 在 较 大 侧 偏 角 的 情况 下 ， 改 
变 车 辆 的 转向 角 对 车 辆 横 皖 角速度 产生 很 小 的 改变 , 这 与 在 低速 下 的 横 摆 角速度 
有 很 大 不 同 。 在 干燥 路 面 上 ， 车 辆 在 侧 偏 角 大 于 10* 的 情况 下 会 失去 操控 性 ， 而 
在 积 雪 路 面 上 ， 侧 偏 角 只 要 达到 4" 车 辆 就 会 失去 操控 性 。 因 此 对 于 无 人 驾驶 汽 
车 来 说 ， 应 当 确 保 车 辆 横向 力 保持 在 线性 范围 内 ， 这 样 ， 就 可 以 保持 车 辆 在 道路 
上 行驶 时 更 加 安全 、 平 稳 。 


5.2.2 路径 跟 踪 的 安全 转向 约束 


考虑 行车 过 程 中 的 安全 性 策略 , 要 确保 无 人 车 安全 、 平稳 地 跟随 决策 系统 规 
划 的 路 径 , 我 们 以 侧 偏 角 和 横 摆 角 速度 安全 限制 为 依据 , 计算 车 辆 转向 控制 的 输 
出 量 约束 。 如 果 路 面 摩擦 系数 不 能 提供 高 横 择 角 速度 下 的 轮胎 力 , 那么 尝试 去 得 
到 根据 轨迹 计算 出 的 期 望 横 摆 角速度 是 不 安全 的 ， 此 时 的 期 望 轨迹 为 不 合理 的 ， 
为 了 保证 车 辆 能 够 安全 行驶 应 对 其 加 以 限制 , 理想 的 横 摆 角 速度 必须 控制 在 根据 
与 轮胎 一 路 面 摩擦 系数 的 关系 所 确定 的 上 限 值 范围 内 。 

由 车 辆 动力 学 可 知 ， 当 车 辆 以 速度 上 行驶 在 半径 为 R 的 轨道 上 ， 车 辆 的 期 
望 侧 偏 角 为 : 
at OEL OER a 

R 2C., +l) R GD 

车 辆 稳定 行驶 在 半径 为 R 的 轨道 上 时 ， 前 轮 稳 态 转向 角 与 车 速 六 及 轨道 半 

径 只 的 关系 有 : 


B 
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A a 





== R 2c/CAU +1) R 6D 
结合 以 上 两 式 有 : 
ln 
Page 2) 





mV71,C, —mV'1,C, 
2C,C_ (1, +1,) 
ESS, WAA: 
Prope sone = t00" (0.02g) 


G,+h)+ 63) 


(5.4) 
一 般 干 路 面 的 摩擦 系数 /=09， 对 应 侧 偏 角 上 限 为 10*， 积 雪 路 面 摩擦 系数 
J=0.35， 对 应 侧 偏 角 上 限 为 4*(Tohru Yoshioka,1999)。 
由 式 (53)， 代 人 表 4.1 所 列 出 的 车 辆 动力 学 参数 ， 可 得 侧 信 角 的 上 限 值 为， 
2 _ 1.595+0.01144y? 
‘ere tow 3.025 +0.003875V7 65 


根据 上 式 可 知 ,在 车 辆 实时 速度 的 限制 下 ,前 轮转 角 的 上 限 值 与 速度 的 关系 
可 用 如 图 5.3 的 关系 表示 。 例如 ， 当 速度 为 80km/h(22.2ns) 前 轮 方向 角 的 上 限 值 
为 8， 超过 8* 就 可 能 会 发 生 侧 翻 的 危险 。 
25 





20 
15 
0 
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‘steering upper bound(? 


g 5 10 5 20 25 30 
Speed(m/s) 


图 $3 速度 对 应 前 轮转 角 的 侧 翻 临界 什 


汽车 在 弯曲 的 道路 上 行驶 时 ， 质 心 的 横向 加 速度 为 : 
a, =iyty 66) 


式 中 ， 了 为 车 辆 横向 速度 ， 大 为 车 辆 纵向 速度 ， Voremanan, d 
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于 
jei) 67 
横 摆 角速度 和 车 辆 侧 偏 角 以 及 横向 加 速度 的 关系 为 : 
a, = iy +itan(f)+ ail 
1+tan*(f) 68) 
横向 加 速度 也 必须 受到 轮胎 一 地 面 摩擦 系数 h 的 限制 : 
a, Sug 69) 


若 除 非 紧急 情况 ， 则 在 考虑 行车 安全 的 基础 上 还 需 兼顾 乘坐 舒适 性 ， 
Wonslaik Chee(1991) 和 Masato Abe, et al.,2001) 中 提 到 ,为 了 保持 乘坐 的 舒适 
性 ， 在 公路 和 城市 道路 上 ， 通 常 横向 加 速度 建议 a,<0.6mys2, 这 也 是 在 许多 车 辆 
弯 道 行驶 控制 研究 中 常用 的 数据 。 

横向 加 速度 的 计算 主要 由 式 (5.8) 首 项 决定 如 果 车 辆 侧 偏 角 和 它 的 导数 都 比 
较 小 ,第 二 项 和 第 三 项 只 占 总 的 横向 加 速度 很 小 的 部 分 。 因 此 综合 (5.8) 式 和 (5.9) 
式 ， 模 摆 角速度 的 上 限 确定 为 : 


or 0.51 
ý, = 0,85 m 
pens Vy v (5.10) 
根据 车 辆 动力 学 有 ， 车 辆 行驶 速度 为 y， 前 轮转 角 为 5 时 ， 理 论 横 扣 角速度 
为， 
Vil, +1,) 
mt 
Gly Cy Cy 


a 
a 


l+ 





(6.11) 


表 4.1 MISSI ER, TAO MIR ME ER 
s __V/3025 051 
Wrore tent “13000032 V (5.12) 
根据 上 式 可 知 , ROOT T. AHEM L RR SHIR 
可 用 如 图 5.4 的 关系 表示 。 例 如， 当 速 度 为 80kmhC22 2m 时 ， 前 轮 方向 角 的 上 
限 值 为 1°, Mt le 人 的 乘坐 感受 会 交差 ， 会 明显 感觉 到 因 横 向 加 速度 较 大 而 产 
生 的 横向 甩 动 。 
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图 54 速度 对 应 前 轮转 角 的 舒适 度 临界 值 


为 了 车 辆 行驶 安全 并 考虑 到 乘坐 舒适 性 , 车 辆 的 驾驶 行为 就 应 该 尽 可 能 的 远 
离 图 53 和 图 5.4 所 示 的 极限 取 值 ， 车 辆 的 模 摆 角 速度 和 侧 偏 角 不 能 过 大 。 对 于 
轨迹 跟踪 的 横向 控制 器 , 输出 过 大 的 转向 角 容 易 引起 控制 系统 超 调 , 在 速度 较 高 
的 情况 下 ， 甚 至 会 导致 系统 失控 ,失控 后 的 车 辆 可 能 偏离 期 望 轨迹 而 引起 碰撞 的 
危险 。 


5.2.3 ”安全 速度 约束 


如 前 文 所 述 控制 器 同时 输出 过 大 的 速度 值 和 过 大 转角 时 ， 系 统 会 失去 稳定 。 
因此 需要 对 车 辆 的 期 望 轨迹 做 出 预先 计算 , 期 望 轨迹 的 曲率 较 大 时 需要 提前 降低 
速度 ， 让 车 辆 平缓 行驶 过 弯 。 

根据 第 四 章 的 分 析 有 ,车 辆 以 速度 V 通过 半径 为 R 的 圆 轨道 时 ， 期 望 横 摆 角 
速度 为: 

MEEA 
STR (5.13) 

当期 包 模 所 角 这 度 大 于 上 文 的 模 扣 角 轩 度 上 限时 ， 就 应 提前 降低 速度 设 定 
值 。 

车 定义 Oiu 为 控制 器 根据 期 望 模 摆 角速度 计算 输出 的 期 望 前 轮转 角 ， 根 据 图 
5.1 和 图 5.2 所 示 极 限 情况 下 前 轮转 角 与 速度 的 关系 图 , 可 以 求 出 bu 转角 对 于 的 
侧 偏 角 极限 速度 w 和 横 摆 角速度 极限 速度 w。 此 时 定义 纵向 控制 器 的 速度 设 定 
值 为 : 


va =min (vO s 
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其 中 Vo( 及 为 该 路 段 交 通 规则 规定 的 速度 限制 ，w( 局 ,vy( 生 上 文 已 定义 :ve( 局 
为 决策 系统 的 速度 设 定 , 该 速度 考虑 了 其 他 车 辆 的 前 后 安全 车 距 及 侧 边 的 突 发 情 
Re 


53 实验 结果 及 分 析 


(1) 基于 PD 控制 算法 的 矩形 路 径 跟 踪 实验 
PID 跟踪 控制 的 一 个 特点 是 能 够 较为 准确 的 跟踪 一 条 路 径 函 数 为 一 阶 、 二 阶 
且 导 数 不 连 续 的 路 径 . 为 了 评价 算法 的 性 能 ,实验 中 "智能 先锋 "将 以 10m/s 和 20 
m/s 的 速度 对 这 条 类 似 矩 形 的 路 径 进行 轨迹 跟踪 实验 ， 并 在 不 同 的 速度 下 设 定 不 
同 的 预 瞄 距 离 , 速度 越 快 需要 预 瞄 距离 越 远 , 以 增加 阻尼 来 保证 控制 系统 的 稳定 。 
实验 在 10m/s 和 20 m/s 的 速度 下 分 别 取 预 瞳 距 离 为 15m 和 20m, 实验 结果 如 图 
5.5、 图 5.6 所 示 。 
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图 $.6 PID 控制 算法 20kmhh MERRER 


从 图 中 ， 明 显 可 以 看 出 ， 采 用 PID 控制 算法 的 预 圈 跟 随 控制 器 ， 通 过 预先 
设 定 预 瞄 距离 的 方式 ， 车 辆 能 够 以 较为 平滑 的 方式 通过 90 度 〈 或 略 小 于 90 E) 
的 转弯 ， 在 10km/h 速度 时 ， 对 期 望 轨迹 跟踪 的 误差 很 小 ， 但 当 速度 增加 时 ， 若 
采用 同样 的 PID 参数 ， 转 弯 时 的 精度 开始 下 降 ， 在 20km/h 速度 下 转弯 处 跟踪 误 
差 最 大 达到 4m, 见 图 5.7。 由 于 速度 的 增加 和 前 轮转 角 角 度 的 增加 同时 影响 了 之 
前 所 建立 的 简化 车 辆 模型 的 精度 ， 并 且 使 被 控 对 象 呈现 非 线性 特性 ， 此 时 系统 的 
动态 特性 已 经 发 生 了 变化 ， 理 想 状况 下 所 整定 的 PD 控制 器 对 于 变化 的 控制 对 
象 难以 实施 最 优 的 控制 效果 。 当 速度 增加 到 30km/h 以 上 时 ,系统 开始 出 现 震 荡 ， 
车 辆 将 在 期 望 轨迹 左右 出 现 蛇 形 的 轨迹 。 
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图 5.7 PID 控制 30km/h 轨迹 跟踪 转弯 处 误差 


由 以 上 实验 结果 可 见 ,PID 跟踪 控制 在 曲率 不 大 的 路 径 ， 以 低速 行驶 时 跟踪 
精度 较为 准确 并 具有 一 定 的 鲁 棒 性 ， 当 速度 提高 时 ， 系 统 动态 特性 发 生 改 变 ， 原 
有 的 PID 参数 不 能 达到 最 优 的 控制 效果 ， 因 此 设计 一 种 能 够 实现 根据 系统 动态 
特性 的 变化 自动 调整 PID SAM ARE PID 控制 系统 是 非常 必要 的 。 

(2) 基于 CMAC 与 PID 复合 的 控制 算法 的 矩形 路 径 跟踪 实验 

由 上 一 节 实验 结果 可 知 PID 跟踪 控制 在 低速 或 直线 跟踪 时 ， 控 制 效果 很 好 ， 
但 当 系 统 表现 出 非 线性 特性 时 ，PID 的 跟踪 精度 就 开始 下 降 。 为 了 适应 城市 环境 
的 多 样 性 ， 前 面 设计 了 CMAC 与 PID 复合 的 控制 器 能 够 自动 的 适应 系统 动态 特 
性 的 变化 ， 下 面 将 以 实验 验证 CMAC 与 PID 复合 的 控制 器 在 类 和 矩形 轨迹 和 8 字 
型 轨迹 条 件 下 的 跟踪 效果 。 

实验 中 “智能 先锋 "将 以 30 m/s 和 60km/h 的 速度 对 这 条 类 似 矩 形 的 路 径 进行 
轨迹 跟踪 实验 ， 实 验 结果 如 图 5.8、 图 5.9 所 示 。 


i 
sise 000000 


第 五 章 “智能 先锋 ”控制 系统 实验 分 析 











nes — — 
-一 see meaoy 
nsu acta aptny 
narsi 
nani 
BD 4 
i nan 
nans} 
aen 
naros 


aar 





SUF ae 17 6 MT TT eT TT HT TUT TTT 103 
lenge 


图 $8 CMAC 与 PID RAHA 30kmv/h 轨迹 跟踪 结果 
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M 5.9 CMAC 4 PID 复合 控制 b0imh MERRER 


从 上 图 中 可 以 看 出 ， 采 用 CMAC 与 PID 复合 的 控制 算法 后 ， 车 辆 能 够 在 
30km/h 和 60km/h 时 以 较为 平滑 的 方式 通过 90 度 (或 略 小 于 90 BED 的 转弯 ， 跟 
踪 误差 较 小 。 

由 于 60km/h 的 速度 转 90 度 的 转达 容易 发 生 危 险 , 上 文 所 提 及 的 安全 转向 和 
速度 约束 机 制 根据 期 望 轨 迹 的 曲率 预先 限制 了 设 定 速度 ， 图 $9 记录 了 60km/h 
行驶 过 程 中 速度 的 设 定 什 和 速度 跟踪 情况 ， 从 图 中 看 出 根据 安全 约束 机 制 ,在 转 
弯 处 的 速度 会 及 时 的 降低 ， 又 由 车 辆 纵向 控制 器 对 平稳 性 的 要 求 ， 车辆 在 完成 转 
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弯 进 入 直道 后 实时 速度 平缓 提升 。 图 5.10 和 图 5.11 分 别 记录 了 两 组 实验 过 程 中 
的 跟踪 误差 ,图 5.10 说 明 在 CMAC 与 PID 复合 的 控制 算法 作用 下 车 辆 以 30km/h 
的 速度 跟踪 轨迹 误差 最 大 为 0.5m， 比 纯 PID 控制 方法 的 跟踪 精度 提高 很 多 ， 图 
5.11 说 明 在 转弯 处 根据 安全 速度 约束 降低 速度 后 ， 能 够 提高 系统 跟踪 精度 ， 跟 踪 
误差 最 大 为 04m。 图 5.12 和 图 5.13 分 别 记录 了 在 矩形 路 径 行驶 过 程 中 的 横 摆 角 
速度 和 纵向 加 速度 , 从 图 中 看 出 行驶 过 程 中 横 摆 角速度 变化 范围 为 [0.0.4], 纵 向 加 
速度 变化 范围 为 [-2.5,1]， 符合 行驶 平稳 性 和 舒适 性 的 要 求 ， 实 现 了 预期 的 设计 目 
标 。 
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图 5.10 30kmh 轨迹 不 踪 的 跟踪 误差 曲线 
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图 S.11 60km/h 轨迹 跟踪 的 跟踪 误差 曲线 
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图 5.13 60kmhmh 轨迹 跟踪 的 纵向 加 速度 变化 曲线 
(3) 8 字形 轨迹 归 踪 


为 了 验证 "智能 先锋 "无 人 车 变 道 行驶 的 性 能 ， 并 对 比 纯 PID 与 基于 CMAC 
与 PID 复合 的 控制 算法 的 效果 ,实验 以 15m/s 的 速度 分 别 使 用 这 两 种 控制 算法 对 
各 字 型 "的 路 径 进行 轨迹 跟踪 实验 ， 为 了 保证 轨迹 跟踪 的 精度 ， 实 验 选择 较 短 的 
预 晓 距 离 。 图 5.14 和 图 5.16 分 别 记 录 两 组 实验 的 跟踪 结果 ， 图 示 可 见 。 实 验 中 ， 
由 图 5.15 可 见 采用 PID 控制 在 车 辆 转 过 第 二 弯 道 时 ， 系 统 由 于 超 调 产生 了 震荡 
而 终止 了 实验 , 而 采用 CMAC 与 PID 复合 的 控制 方法 后 能 够 有 效 抑制 系统 超 调 ， 
并 顺利 通过 了 后 两 个 更 急 的 转弯 。 
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图 5.14 PID 控制 15km/h 轨迹 跟踪 结果 
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图 5.15 PID 控制 1Skmh HEIER HE At 
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图 $.16 CMAC 与 PID 复合 的 控制 15km/bh 轨迹 跟踪 结果 


图 5.17 和 图 5.18 记录 了 两 组 实验 过 程 中 的 横 择 角 速度 ， 分 析 可 见 图 5.17 的 
最 后 出 现 了 很 大 的 震荡 ， 车 辆 出 现 了 蛇 形 运动 ， 导 致 实验 必须 终止 ， 图 5.18 所 
记录 的 横 摆 角速度 没有 出 现 上 下 波动 表明 车 辆 在 转弯 时 没有 出 现 超 调 , 行驶 过 程 
很 稳定 ， 实 验 结果 验证 了 基于 CMAC 与 PID 复合 的 控制 方法 比 纯 PD 控制 方法 
更 稳定 ， 更 适用 于 路 径 曲率 变化 范围 较 大 的 跟踪 。 
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图 $.17 PID 控制 8 字形 轨迹 跟踪 的 横 抬 角 速度 变化 曲线 
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图 5.18 CMAC 与 PID 复合 控制 8 PIE PERERA RIE a I MEHL dh R 











(4) 基于 安全 约 东 的 8 字形 轨迹 跟踪 

为 了 进一步 验证 基于 CMAC 与 PID 复合 控制 的 控制 算法 控制 车 辆 进行 弯 道 
行驶 的 性 能 , 实验 以 最 高 速度 30kmh 的 速度 对 8 字 型 的 路 径 进行 轨迹 跟踪 实验 。 
由 之 前 的 矩形 路 径 跟踪 实验 可 知 , 车 辆 期 望 速度 的 选择 也 对 控制 算法 的 效果 有 着 
显著 地 影响 。 期 望 速度 越 大 的 话 ， 为 了 保证 车 辆 行驶 的 安全 性 和 稳定 性 ， 前 面 的 
章节 提 到 了 前 轮转 向 角 的 约束 条 件 ， 为 了 使 转向 角 尽 量 小 ， 其 预 蜡 距离 就 越 大 ， 
其 相应 的 跟踪 误差 就 会 越 大 。 从 图 5.16 的 跟踪 结果 中 也 可 以 看 出 ， 在 跟踪 较 急 
的 两 个 转 恋 时 ， 出 现 了 较 大 的 轨迹 误差 ， 因此 为 了 不 损失 跟踪 精度 就 需要 对 速度 
加 以 限制 。 根 据 前 文 所 规定 的 安全 速度 约束 ，30km/h 速度 的 跟踪 实验 中 根据 硒 
道 的 曲率 改变 的 速度 的 设 定 值 ， 图 5.18 记录 实验 跟踪 路 径 的 结果 ， 由 图 可 见 车 
辆 对 轨迹 跟踪 的 非常 准确 。 图 5.19 和 图 5.20 记录 15kmh 匀速 跟踪 路 径 和 根据 安 
全 速度 限制 的 30kmvh 变速 行驶 过 程 中 的 误差 数据 。 由 图 可 见 ，15kmh 匀速 行驶 
时 在 两 个 急 转 弯 处 出 现 误差 的 峰值 ， 误 差 接近 2m， 在 曲率 较 小 或 直线 路 段 误差 
才能 保持 在 0.5m 以 内 ， 当 根据 道路 曲率 提前 对 设 定 速度 进行 控制 后 ， 全 程 的 误 
差 都 能 够 保持 在 0.5m 范围 内 。 
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tracking error(m) 


图 5.21(a) 记 录 了 在 实验 过 程 的 速度 数据 ， 可 见 车 辆 行驶 在 四 个 转变 时， 车 
速 降 至 接近 10km/h， 在 直道 路 段 行驶 时 速度 为 30km/h， 在 恋 道 行驶 时 ， 根 据 弯 
道 的 曲率 控制 车 速 在 20km/h 左右 。 图 5.21(b) 显 示 了 在 实验 过 程 中 记录 的 预 瞻 距 
离 数 据 ,，“ 智 能 先锋 "在 低速 的 情况 下 其 预 瞄 距离 也 较 小 , 这 样 的 设 定 可 以 使 车 辆 
行驶 在 弯 道 中 ， 更 加 贴 合 给 定 轨迹 ， 跟 踪 误差 较 小 ,这 一 点 也 符合 轰 驶 员 在 弯 道 
行驶 时 的 策略 ， 车 辆 若 要 通过 一 些 角度 较 大 的 弯 道 ， 必 须 提前 减速 。 相 反 地 ， 如 
果 订 道 的 曲率 较 小 车 辆 在 速度 较 高 的 情况 下 , KABERLAML BK, WAR 
统 的 阻尼 才能 满足 驾驶 行为 平缓 稳定 的 要 求 ， 图 5.21(c) 记 录 了 实验 过 程 中 预 瞄 
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图 5.18 CMAC 与 PID 复合 控制 30km/h 变速 度 轨迹 跟踪 结果 








time(0.1s) 
图 5.19 15kmh 速度 轨迹 跟踪 误差 
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10000 
time(0. 1s) 
图 5.20 30km/b 变速 度 轨 迹 跟 踪 误差 
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跟随 控制 器 的 转向 角 输 出 ， 正 如 预期 的 那样 ， 低 速 过 程 中 的 转向 角 很 大 ， 使 车 辆 
可 以 顺利 通过 急 转 弯 。 图 5.21(d) 记 录 了 实验 过 程 中 横 摆 角速度 的 输出 ， 可 见 模 
扬 角 的 变化 范围 在 -0.5rad/s~0.5rad/s 之 内 ， 保 证 了 车 辆 行驶 过 程 平稳 性 。 
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(qd) 变速 度 轨迹 跟踪 横 摆 角 速度 变化 曲线 
图 $21 实验 中 基于 安全 约束 的 各 参数 变化 


以 上 实验 验证 了 本 文 所 设计 的 无 人 驾驶 车 辆 控制 系统 可 以 有 效 地 控制 汽车 
按照 预期 的 轨迹 和 速度 行驶 ， 体 现 出 较 好 的 轨迹 跟随 能 力 ， 且 对 车 速 、 道 路 状况 
等 汽车 行驶 过 程 中 的 动态 不 确定 性 因素 具有 较 强 的 适应 性 和 鲁 棒 性 。 
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54 本章 小 结 


本 章 中 ,根据 前 文 设计 的 车 辆 纵向 和 横向 控制 设计 方法 , 设计 了 无 人 驾驶 真 
实 城市 环境 下 的 实 车 实验 。 并 且 在 实验 之 前 针对 城市 道路 环境 的 无 人 驾驶 车 辆 行 
驶 安全 性 进行 了 探讨 , 从 高 速 过 这 或 换 道 的 行驶 安全 性 和 千 适 性 上 考虑 了 车 辆 纵 
向 控制 和 横向 控制 之 间 相 互 制约 关系 , 在 保证 了 无 人 驾驶 车 辆 控制 系统 的 安全 稳 
定性 的 基础 上 对 控制 系统 进行 了 实验 验证 ,实验 表明 , 这 种 控制 系统 具有 良好 的 
跟踪 效果 ， 同 时 具有 安全 稳定 的 特性 ， 符 合 车 辆 在 城市 道路 中 的 行驶 要 求 。 
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本 文 对 无 人 驾驶 车 辆 在 城市 环境 中 的 运动 跟踪 、 控 制 技术 进行 了 深入 的 研究 
设计 了 针对 城市 环境 的 无 人 驾驶 车 辆 纵向 和 横向 控制 系统 , 制定 了 无 人 车 行驶 安 
全 性 约束 ， 并 在 此 基础 上 进行 了 实 车 实验 验证 。 本 文 的 主要 贡献 可 归纳 如 下 ; 

1) 对 无 人 驾驶 车 辆 的 工作 环境 -城市 化 道路 进行 了 归纳 总 结 , 明确 了 无 人 车 
各 类 行车 道路 的 特点 和 难点 ， 比 如 交通 结构 差 交通 工 具 种 类 繁多 , 行驶 在 城区 
道路 中 的 摩托 车 、 自 行车 、 人 力 车 、 残 疾 人 车 数量 频 大 。 市 民 交通 意识 差 ， 交 通 
参与 人 包括 汽车 驾驶 人 违章 现象 较为 严重 等 。 进而 , MAT RAR AES ROM 
市 道路 中 行驶 所 可 完成 的 任务 ， 同 时 ， 也 表明 了 无 人 驾驶 车 辆 控制 系统 的 设计 目 
标 ， 即 使 得 车 辆 能 够 像 "驾驶 员 "一 样 驾驶 车 辆 ， 平 稳 行驶 ， 控 制 准确 。 

2) 设计 、 建 立 了 一 种 基于 规则 的 专家 PID 速度 控制 系统 。 在 车 辆 纵向 动力 
学 分 析 的 基础 上 ， 亲 明了 行车 环境 中 影响 车 辆 行驶 速度 的 一 些 关键 因素 。 从 而 ， 
可 知 车 辆 行驶 时 不 确定 因素 干扰 较 大 ， 车辆 模型 实时 变化 ， 星 高度 非 线性 , 建立 
较为 准确 的 控制 对 象 模型 很 困难 .而 在 实际 驾驶 员 对 车 辆 的 速度 控制 中 , 并 不 需 
要 了 解 车 辆 的 准确 模型 ， 只 要 有 一 定 的 驾车 经 验 , 简单 了 解 车 辆 的 动态 特性 ,就 
能 把 速度 调整 在 期 望 的 设 定 值 上 。 因 此 ， 采 用 专家 PID 控制 的 方式 设计 车 辆 纵 
向 控制 器 , 同时 给 定 了 油门 与 制 动 控制 时 的 专家 规则 . 在 车 辆 纵向 控制 的 实 车 实 
验 中 ,可 以 看 出 , 在 复杂 的 路 况 条 件 下 ,该 控制 器 依然 可 以 对 不 同 的 期 望 速度 进 
行 准确 、 快 速 地 跟踪 。 

3) 提出 了 一 种 新 的 基于 小 脑 模型 神经 网 络 与 PID 复合 的 无 人 驾驶 车 辆 横向 
控制 算法 ， 首 先 ， 建 立 了 车 辆 横向 动力 学 模型 ， 并 且 根据 无 人 驾驶 车 辆 的 模型 参 
数 ， 获 得 车 辆 的 运动 方程 ， 明 确 了 车 辆 横向 稳定 性 参数 横向 速度 与 横 摆 角速度 ; 
接着 ， 利 用 相对 道路 的 车 辆 运动 学 模型 ， 进 行 了 状态 反馈 控制 设计 ， 由 于 上 述 控 
制 器 的 设计 建立 在 道路 通畅 , 并 且 无 较 大 的 转弯 的 情况 下 , 城区 道路 已 不 再 适用 ， 
进而 设计 并 实现 了 CMAC 与 PID 复合 控制 的 车 辆 横向 控制 器 ， 该 控制 器 能 够 自 
动 补偿 被 控 模型 和 输入 信号 发 生 的 非 预 知 的 变化 , 解决 了 由 于 模型 不 太 精确 或 存 
在 其 他 变化 因素 带 来 的 控制 不 确定 性 ， 使 系统 仍然 能 够 保持 预期 设计 要 求 的 性 
fe. 实验 中 ， 通 过 Matlab 仿真 与 基于 "智能 先锋 "智能 车 辆 平台 进行 实 车 实验 两 
种 方式 对 控制 算法 进行 了 验证 ， 通 过 与 传统 PID 算法 进行 对 比 的 方式 ,证 明了 
该 控制 算法 的 有 效 性 和 优越 性 。 

人 对 面向 城市 道路 环境 的 无 人 驾驶 车 辆 行驶 安全 性 进行 了 深入 的 研究 。 具 
体 从 高 速 过 恋 或 换 道 的 行驶 安全 性 路径 跟踪 安全 约束 两 方面 对 行驶 安全 性 进行 
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阐述 ， 研 究 中 ， 主 要 考虑 了 车 辆 高 速 行驶 时 的 运动 学 特性 ， 车 辆 纵向 控制 和 横向 
控制 之 间 相互 制约 关系 , 保证 了 无 人 驾驶 车 辆 控制 系统 的 安全 稳定 性 。 在 此 安全 
保障 的 基础 设计 了 真实 城市 环境 下 的 不 同 场景 的 实 车 实验 , 进一步 验证 了 本 文 所 
设计 的 无 人 驾驶 车 辆 控制 系统 , 它 能 够 解决 车 辆 城市 环境 道路 中 自主 行驶 所 面临 
的 问题 。 

智能 车 辆 技术 是 近年 来 新 兴 的 一 种 不 断 发 展 和 创新 的 技术 , 体现 了 当今 信息 
科学 与 智能 控制 技术 的 最 新 成 果 。 车 辆 的 控制 系统 研究 融合 了 多 种 学 科 知识 ,如 
计算 机 科学 、 自 动 控制 、 电子 信息 工程 、 导 航 定位 技术 、 检测 技术 和 人 工 智能 等 ， 
研究 难度 较 大 ,本 文昌 然 在 无 人 驾驶 车 辆 横向 与 纵向 控制 的 研究 中 取得 了 一 定 的 
进展 ， 但 仍然 有 许多 问题 有 待 进一步 开展 和 研究 ; 

D 文中 所 设计 的 纵向 控制 是 基于 专家 PD 控制 的 方法 ， 模 拟 驾驶 员 的 驾车 
行为 抽象 出 了 一 些 最 基本 的 规则 ,本文 这 个 方面 的 研究 只 是 个 开始 , 还 需要 把 专 
家 PID 控制 方法 进行 深入 细致 地 研究 ， 需 要 在 各 种 路 况 条 件 下 进行 与 驾驶 员 实 
际 驾车 的 对 比 实验 , 研究 驾驶 员 在 各 种 交通 状况 下 对 速度 的 处 理 行为 ， 制 定 相应 
的 专家 规则 ， 以 最 大 程度 的 “拟人 化 "实现 对 车 辆 速度 智能 控制 的 目标 。 

2) 文中 所 设计 的 横向 控制 是 基于 CMAC 与 PD 复合 控制 的 方法 ， 由 于 
CMAC 是 局 部 神经 网 络 ， 也 具备 模糊 模型 的 结构 ， 如 果 在 后 续 工作 中 加 入 模 类 
控制 的 思想 ,根据 实际 应 用 的 要 求 建立 模糊 规则 ， 就 能 成 为 模糊 神经 网 络 。 这 样 
的 控制 系统 将 会 在 原 有 CMAC 网 络 的 学 习 速 率 快 和 具有 自 适 应 性 的 特点 上 ， 又 
增加 了 模糊 控制 系统 所 具有 的 控制 方法 易于 理解 ， 设 计 简单 透明 ,便于 实际 应 用 
等 特点 ， 并 且 可 以 更 方便 地 利用 专家 知识 来 修正 CMAC 网 络 的 初始 权 值 ， 结 合 
模糊 思想 的 车 辆 横向 控制 器 将 更 能 灵活 的 解决 各 种 环境 和 工 况 下 的 系统 控制 问 
题 。 

3) 本 文 的 设计 思想 都 是 建立 在 控制 系统 自身 的 性 能 ， 今 后 的 工作 应 该 从 无 
人 驾驶 车 辆 的 全 系统 性 能 考虑 ,文中 所 设计 的 车 辆 运动 控制 系统 , 将 控制 系统 分 
为 纵向 控制 和 横向 控制 ,而 忽略 了 垂直 方向 的 动力 学 影响 。 但 实际 道路 行驶 过 程 
中 ,由 于 道路 的 起 伏 或 中 凸 不 平 会 造成 车 辆 的 颠 徐 ， 车 辆 存在 z 轴 方 向 上 的 运动 
和 自身 的 傍 促 运动; 另外， 控制 车 速 的 改变 时 对 刹车 或 油门 的 操作 ， 都 会 对 车 辆 
的 姿态 产生 影响 而 改变 车 辆 的 俯仰 角度 , 此 时 , 传感器 可 能 会 发 生 误 检测 的 现象 ， 
从 而 使 得 决策 系统 的 路 径 决策 判断 错误 若 把 以 上 因素 也 考虑 进去 , 用 以 修正 由 
于 车 身 次 态 变化 产生 的 轨迹 规划 误差 ， 将 会 使 控制 系统 的 控制 精度 得 到 提高 。 

在 国家 自然 科学 基金 委员 会 的 支持 下 国内 无 人 车 相关 技术 得 到 了 快速 的 发 
展 , 但 要 实现 无 人 车 辆 真正 的 自主 行驶 还 存在 较 大 的 差距 ， 相 信 在 广大 研究 人 员 
的 努力 下 ,无 人 驾驶 车 辆 技术 及 其 衍生 技术 将 会 大 大 改善 人 类 的 生活 。 
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